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ABSTRACT  (  /  /  f  '  j 

A  nonlinear  controller  is  designed  for  a  full  size 
submarine  using  the  LQG/LTR  procedure.  Linear  models  of  the 
submarine  are  developed  at  four  different  speeds  and  then 
analyzed  using  the  method  of  modal  analysis.  The  linear 
models  are  then  augmented  with  integral  control  and  a  Kalman 
Filter  transfer  function  is  designed  using  some  tools  for 
loop  shaping.  The  Loop  Transfer  Recovery ^technique  is  then 
applied  to  recover  the  Kalman  Filter  loop  shapes.  A 
polynomial  data  fit  is  performed  on  the  resulting 
compensators  to  produce  a  nonlinear  controller.  Both  the 
linear  and  the  nonlinear  controllers  are  extensively  tested 
using  a  full  nonlinear  model  of  the  submarine.  ^ 
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Chaptar  1 


INTRODUCTION  AND  SUMMARY 


1.1  Background 

The  technology  -for  building  multi  variable  control  systems 
has  advanced  in  the  last  several  years  and  there  is  a  very 
definite  need  -for  complex  design  examples  to  help  engineers 
understand  and  further  develop  this  powerful  design 
met hodol ogy . 

Multi-inputf  multi -output  (MIMO>  control  system  design  is 
much  more  complex  than  either  classical  control  system 
design  or  single-input,  single-output  (SI50)  control  system 
design.  The  engineer  must  use  and  manipulate  the  singular 
values  of  the  loop  transfer  function  matrix  of  the  plant  to 
determine  the  performance  of  the  controller  and  this  concept 
of  singular  values  as  a  measure  is  at  present  relatively 
unknown  to  most  control  engineers.  Therefore,  it  is 
necessary  to  apply  the  MIMO  methodology  to  practical 
examples  in  order  to  display  the  power  of  this  technique  and 
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also  to  point  out  any  shortcomings. 

To  data,  non-trivial  axamplas  o-f  MIliO  design  using  the 
Linear  Quadratic  Gaussian  procedure  with  Loop  Transfer 
Recovery  (LQG/LTR)  are  few  in  number  (see  Cll  C2]  for  recent 
examples) .  This  is  in  part  due  to  the  LQG/LTR  technique 
having  been  only  recently  developed  C33  C4]  CS3,  and  partly 
due  to  the  significant  effort  required  to  develop  and 
linearize  a  MIMO  modal,  design  the  controller,  and  test  the 
resulting  design. 

Previous  controller  designs  for  submarines  have  used  the 
«  SISO  design  technique  or  classical  design  techniques  C6] 
C71.  This  thesis  is  believed  to  be  the  first  (unclassified) 
example  of  a  MIMO  design  on  a  full-size  submarine.  The 
LQG/LTR  design  methodology  is  used  because  it  incorporates 
the  dynamics  of  the  plant  (the  submarine)  into  the 
compensator  and  thereby  provides  a  vehicle  for  capturing  the 
dynamics  of  the  submarine  at  various  speeds.  This 
information  can  then  be  utilized  to  produce  a  nonlinear 
dynamic  compensator  that  varies  as  some  sensed  parameter 
changes  (gain  scheduling),  providing  adaptive-like  nonlinear 
control  of  the  submarine  over  a  variety  of  speed  conditions 
and  simultaneous  maneuvers.  In  fact,  the  linearized  models 
of  the  submarine  were  selected  so  as  to  emphasize  the 
cross-coupling  of  the  longitudinal  and  lateral  dynamics. 
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1.2  Contributiona  of  the  Thaais 


Th»  ««in  contribution  of  this  thesis  is  to  illustrate  the 
multivariable  LQG/LTR  feedback  control  system  design 
methodology  for  a  maneuvering  submarine,  and,  further,  to 
demonstrate  the  utilization  of  gain  scheduling  to  construct 
a  nonlinear  controller.  The  reader  shoul d  not  interpret  the 
resulting  controller  desion  to  be  a  final  product,  and 


further  research  is  needed  to  use  such  controllers  for  all 
diverse  submarine  maneuvers. 


The  first  stage  of  the  design  process  is  to  achieve  as 
complete  an  understanding  of  the  submarine  model  as  is 
possible.  To  accomplish  this,  the  submarine  model  is 
linearized  about  an  unconventional  operating  trajectory  so 
as  to  capture  longitudinal /lateral  interactions.  The 
resulting  linear  representation  is  decomposed  into  its  modal 
representation.  The  modal  matrices  are  then  graphically 
displayed  to  visualize  the  dynamic  behavior  of  the  submarine 
and  further  manipulated  to  determine  whether  or  not  the 
required  observability/controllability  requirements  of  the 
LQG/LTR  design  process  are  met  under  various  choices  of 


control  and  output  variables. 


The  controller  design  is  based  on  the  LQG/LTR  methodology 
formulated  by  Doyle  and  Stein  C3]  and  refined  by  Athans 
CS]. 

The  design  effort  concentrates  on  the  frequency  domain 
properties  of  the  state  space  representations  of  the 
submarine  model.  Methods  of  shaping  the  singular  values  of 
the  open  loop  plant  transfer  matrix  are  developed  that 
guarantee  the  identical  behavior  of  the  singular  values  at 
both  the  high  and  low  ends  of  the  frequency  spectrum. 
Scaling  of  the  output  variables  is  utilized  to  produce  the 
desired  loop  shapes  at  frequencies  near  crossover. 

The  state  variable  used  for  gain  scheduling  was  taken  to 
be  forward  velocity  in  the  body  reference  coordinate 
system.  Although  gain  scheduling  may  also  be  desired  based 
on  roll  angle  (again  in  the  body  reference  coordinate 
system) ,  this  would  necessarily  be  in  addition  to  the  gain 
scheduling  employed  using  forward  velocity.  Time  domain 
plots  of  nonlinear  simulations  of  the  compensated  system 
designed  at  a  particular  speed  are  presented  to  show  the 
validity  of  that  choice. 

Gain  scheduling  of  the  compensator  designs  is  accomplished 
by  performing  a  least  squares  fit  on  the  individual 
compensator  parameters.  An  algorithm  for  producing  the 
coefficients  resulting  from  a  quadratic  polynomial  least 


squares  -fit  to  matrices  is  presented. 

Finally,  time  domain  plots  o-f  the  gain  scheduled  LQ6/LTR 
compensator  being  applied  to  the  nonlinear  submarine  model 
are  presented  as  a  means  o-f  illustrating  the  resulting 
nonlinear  design. 


1.3  Outline  of  the  Thesis 


Chapter  2  describes  the  process  used  to  model  the 
submarine  and  the  methods  used  to  produce  a  linear  state 
space  representation.  The  computer  implementation  o-f  the 
submarine  nonlinear  and  linear  models  is  brie-f^y  described. 
The  chapter  ends  with  a  discussion  o-f  the  reasoning  used  to 
select  the  output  variables  and  presents  the  performance 
requirements  imposed  on  the  controller  designs. 

In  Chapter  3,  the  eigenstructure  of  the  linear  model  is 
studied  using  modal  decomposition.  Pole-zero  information 
and  singular  value  plots  are  also  utilized  to  further 
display  the  structure  of  the  open  loop  dynamics. 

Chapter  4  contains  the  linear  portion  of  the  design, 
following  the  LQG/LTR  methodology.  Although  the  reader  is 
assumed  to  be  familiar  with  the  work  of  Doyle  and  Stein  C3], 
the  notation  being  used  is  briefly  summarized.  Singular 
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valua  plots  o-f  the  open  loop  submarine  model  plus 

compensator  are  presented  -for  each  design. 

The  gain  scheduling  method  -for  the  compensator  parameters 
is  presented  in  Chapter  S.  Results  of  various  nonlinear 
simulations  are  included  to  display  the  performance, 
focusing  upon  simultanecsus  evasive  maneuvers. 

Chapter  b  contains  a  summary,  conclusions,  and  some 
proposed  directions  for  further  research. 
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Ch«ptar  2 


MATHEMATICAL  MODEL  OF  THE  SUBMARINE 


2.1  Introduction 


Tho  mubmarine  modal  used  in  this  thesis  is  that 
implemented  at  the  Charles  Stark  Draper  Laboratory  (CSDL> 
both  as  a  real-time  simulation  -facility  and  an  analytical 
model  generating  facility.  Details  of  the  latter  are  given 
in  C91. 

This  chapter  discusses  the  equations  used  to  model  a 
submarine  and  presents  a  brief  history  of  the  implementation 
of  the  submarine  model  at  the  CSDL. 

The  software  in  its  present  form  C10]  provides  the  control 
system  designer  with  several  useful  tools.  The  manner  in 
which  these  tools  are  used  to  produce  and  validate  the 
required  linear  models  for  a  gain  scheduling  LQG/LTR 
controller  is  detail edf  as  well  as  the  reasoning  used  to 
select  the  output  variables. 
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The  chapter  ends  with  a  section  on  performance 
requirements  to  be  imposed  on  the  controller  design,  thus 
setting  the  stage  for  analysis  of  the  model  in  chapter  3  and 
finally  the  actual  design  of  the  controller  in  chapter  4. 


2.2  Modeling  of  the  Submarine 

The  generic  model  from  which  most  submarine  models  are 
derived  is  that  given  in  the  original  Naval  Ship  Research 
and  Development  Center  <NSROC)  Report  2510  Ctl3  entitled 
"Standard  Equations  of  Motion  for  Submarine  Simulation." 
The  model  used  in  this  thesis  is  believed  to  be  an 
improvement  of  the  'standard  model'  in  that  it  includes  the 
crossflow  drag  and  vortex  contribution  terms  for  the  five 
degrees  of  freedom  (the  straight  ahead  x-axis  force  is  not 
included) . 

To  establish  the  notation  for  describing  the  submarine 
motion,  a  brief  description  of  the  nonlinear  equations  of 
motion  is  presented. 

Two  reference  frames  are  used  in  deriving  the  equations  of 
motion  for  a  submarine  -  the  body  reference  frame  and  the 
earth  refercMice  frame.  The  former  is  used  because 
hydrodynamic  forces  and  inertias  are  more  readily  computed 
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in  thB  submarine  reference  frame.  For  purposes  of  control 
and  stability  determination,  we  are  also  concerned  with  the 


motion  of  the  submarine  in  the  earth  reference  frame.  The 
relationship  of  the  motion  of  the  submarine  between  these 
two  reference  frames  is  described  by  Euler's  angles  C12]  y, 
6,  and 

y  (Yaw)  -  rotation  about  the  z  axis 
0  (Pitch)  rotation  about  the  y  axis 
4  (Roll)  -  rotation  about  the  x  axis 

where  x,  y,  and  z  represent  the  body  reference  frame  as  it 
changes  according  to  the  indicated  rotations  and  in  the 
order  given.  The  orientation  of  the  submarine  in  its  own 
reference  frame  is  depicted  in  figure  2.1. 
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Figure  2.1-  Submarine  Body  Reference  Frame  Axes 
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The  state  vector  -For  the  submarine  must  therefore  include 
the  six  degrees  o-f  freedom  in  its  own  reference  frame,  the 
three  Euler  angles,  and  any  desired  position  variables  to 
locate  the  submarine  with  respect  to  some  earth  frame 
reference  point.  For  the  purposes  of  this  thesis,  only  the 
depth  position  variable  is  used  and  the  state  vector  for  the 
submarine  model  contains  the  states  summarized  in  table  2.1. 


Table  2.1 
u  »  X  j  <t) 

V  a  X^Ct) 

w  * 

P  a  X^<t) 
q  =  Xg(t) 
r  a  x^(t) 

♦  a  X^<t) 
e  a  Xg<t) 

V  »  X^(t) 


Submarine  State  Variables 
forward  velocity  in  feet /sec 
lateral  velocity  in  feet/sec 
vertical  velocity  in  feet/sec 
roll  rate  in  radians/sec 
pitch  rate  in  radians/sec 
yaw  rate  in  radians/sec 
roll  angle  in  radians 
pitch  angle  in  radians 
yaw  angle  in  radians 
—  depth  in  feet  (positive  downward) 


Notei  u,  V,  w,  and  O  are  in  the  body 

reference  frame.  All  others  are  in  the  inertial 
reference  frame. 


It  should  be  noted  that  the  Euler  angles  only 
approximately  describe  the  submarine  roll,  pitch,  and  yaw 
angles  in  the  earth  reference  frame,  with  the  approximation 
becoming  more  accurate  as  the  magnitude  of  the  Euler  angles 
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approaches  zero.  This  is  due  to  the  fact  that,  in 
transforming  the  coordinates  from  earth  reference  to  body 
reference,  the  Euler  angle  rotations  are  applied 
sequentially,  in  the  specific  order  V,  0,  and  finally 

Using  the  state  variables  of  table  2.1,  the  nonlinear 
equations  of  motion  are  derived  using  force  and  moment 
balances  in  the  submarine  rotating  coordinate  system.  The 
forces  and  moments  due  to  the  submarine  motion  must  be  equal 
to  the  total  forces  and  moments  exerted  by: 

1.  Hydrodynamic  pressures 

2.  Control  forces  and  moments 

3.  Propulsion  or  tow  forces 

4.  Any  other  forces  and  moments 

The  reader  is  referred  to  the  NSROC  Report  2510  C123  for 
details  of  the  derivation  of  the  nonlinear  equations  of 
motion  and  a  description  of  the  hydrodynamic  coefficients 
describing  the  submarine  geometry  and  control  surfaces. 

The  submarine  model  used  in  this  thesis  has  three  control 
variables  -  rudders,  stern  planes,  and  fairwater  planes  (see 
figure  2.2).  The  propeller  is  constrained  to  turn  at  a 
constant  rpm  to  reflect  current  operating  procedures.  The 
control  surfaces  on  the  submarine  are  locked  together  in  the 


sense  that  the  port  stern  plane  de'flects  the  same  as  the 
starboard  stern  plane  and  similarly  'for  the  rudders  and 
fairwater  planes.  Table  2.2  summarizes  the  nomenclature  for 
the  control  surfaces. 

Table  2.2.  Submarine  Control  Surfaces 
ds  a  Uj (t)  -  stern  planes  deflection  in  radians 
db  »  u^^t)  -  fairwater  planes  deflection  in  radians 
dr  B  u^(t)  -  rudder  deflection  in  radians 

2.3  Implementation  of  the  Model 

Initial ly«  the  CSDL  adapted  model  was  implemented  in  the 
simulation  lab  at  CSOL,  resulting  in  a  real  time 
simulation.  A  Digital  Equipment  Corporation  VAX  11-780 
computer  and  a  Computer vi si on  graphics  display  workstation 
are  used  to  provide  both  computer  print-out  and  visual 
display  of  submarine  motion  during  various  maneuvers. 
Joystick  control  is  used  to  input  commands  to  the  control 
surfaces,  with  the  state  of  the  submarine  being  depicted  in 
real  time  against  an  K-y  grid  on  the  graphics  display.  The 
display  also  includes  simulated  instrumentation  to  indicate 
the  current  status  of  the  control  surfaces  and  other 
selected  parameters. 

For  the  purposes  of  analytical  studies  geared  to 
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controller  design,  the  same  set  o-f  nonlinear  equations  was 
later  implemented  on  the  IBM  time  sharing  computer  at  CSDL. 
Considerable  enhancement  was  added  to  the  program  during  the 
transfer  to  aid  the  control  system  designer  in  his  task.  At 
present,  capabilities  of  the  software  includes 

1.  Addition  of  a  user-friendly  executive  routine  to  allow 
modification  of  parameters  and  selection  of  options 
for  a  particular  simulation  run.  This  routine  then 
submits  the  tailored  program  for  background 
execution. 

2.  The  option  of  calculating  A  and  B  matrices  that 
describe  the  linearization  of  that  submarine  about  a 
particular  nominal  point,  in  the  form 

x_<t)  *  A  x(t)  +  B  u(t>. 

3.  The  options  of  setting  control  surfaces  to  fixed 
values,  varying  the  control  surfaces  over  time 
according  to  values  in  a  data  file,  calculation  of  the 
controls  using  full  state  feedback,  or  calculation  of 
the  controls  using  a  LQ6/LTR  derived  compensation. 

4.  Selection  of  computer  print-out  or  plots  (or  both)  of 
the  state  variables  over  time  of  either  the  nonlinear 
model  or  the  linearized  model. 

5.  The  capability  of  searching  for  a  local  equilibrium 


point  for  tho  nonlinear  model  that  is  close  to  a 
desired  nominal  point. 

To  closely  simulate  typical  operating  profiles  of  an 
actual  submarine,  the  propeller  rpm  is  kept  constant  during 
a  particular  run. 


2.4  Generation  of  the  Linear  Model s 


To  perform  gain  scheduling  of  compensator  designs  over  a 
large  speed  range  requires  that  several  linear  models  of  the 
submarine  be  developed.  Extensive  analysis  of  the  submarine 
open  loop  dynamics,  however,  requires  only  a  single  model 
that  captures  most  of  the  dynamic  modes  present  in  the 
submarine.  As  we  remarked  before,  this  linearized  model  was 
obtained  to  capture  significant  longitudinal -lateral 
interactions  in  simultaneous  maneuvers. 

The  submarine  modeled  in  this  thesis  (figure  2.2)  is 
approximately  400  feet  long,  has  the  conventional  stern 
configuration  (stern  control  surfaces  are  in  the  shape  of  a 
cross),  and  planes  mounted  on  the  sail  (fairwater  planes). 
The  lack  of  differential  control  for  the  control  surfaces 
and  the  conventional  stern  configuration  prevent  any  direct 
control  over  rol 1  or  roll  rate  of  the  submarine.  For  this 


-  21 


reason,  the  initial  linear  model  should  be  such  that  roll 
does  not  dominate  the  submarine  behavior  nor  is  it  absent 
either.  The  nominal  point  used  for  analysis  uses  a  forward 
velocity  of  20  knots,  5  degrees  of  rudder,  and  one  degree  on 
each  of  the  planes.  This  places  the  submarine  in  a  diving 
turn  with  the  trajectory  that  of  a  helix.  Other  state 
variables  are  as  determined  by  an  equilibrium  point  search 
with  these  initial  conditions.  Analysis  of  this  model  is 
presented  in  the  next  chapter. 


Figure  2.2.  Submarine  Control  Surfaces 

The  control  variables  used  in  the  controller  designs  are 
ds,  db,  and  dr  (refer  to  table  2.2),  the  angular  deflections 
of  the  three  control  surfaces.  Deflection  limits,  as 


imposed  by  the  software,  are  40  degrees  for  the  stern  planes 
and  rudder,  and  20  degrees  for  the  sail  planes. 


Linearization  o-f  the  nonlinear  equations  o-f  motion  is 


performed  in  a  straightforward  manner.  A  nominal  point  is 
determined  by  integrating  the  nonlinear  equations  of  motion 
using  a  selected  set  of  initial  conditions,  and  an 
equilibrium  point  is  found  that  corresponds  to  minimum 
accelerations  for  all  state  variables  very  near  the  steady 
state  values  determined  from  the  integration  of  the 
equations  of  motion.  For  the  nonlinear  aquations  of  motion, 
there  are  11  state  variables  since  the  control  surface 
deflections  are  also  independent  variables  (V  and  z  have  no 
effect  on  the  integration).  Thus  an  equilibrium  point  is 
more  precisely  defincKl  as  a  local  minimum  in  11-space.  The 
values  of  the  state  variables  at  the  equilibrium  point  then 
describe  a  nominal  point,  about  which  high  order  terms  can 
be  neglected.  A  set  of  linear  differential  equations  can 
then  be  produced,  and  the  A  and  B  matrices  calculated,  to 
provide  a  state  space  description  of  the  submarine. 

For  each  nominal  point  thus  determined,  the  resulting 
linear  model  must  be  validated  by  perturbing  the  nominal 
point  to  form  a  set  of  initial  conditions,  and  then 
comparing  the  results  of  integrating  both  the  nonlinear  and 
the  linear  equations  of  motion.  Provided  the  perturbations 
are  not  too  large,  the  nonlinear  model  will  always  return  to 
the  equilibrium  point  values,  while  the  linear  model  will 
never  reach  steady  state  due  to  the  non-zero  forcing  term 
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imposed  by  the  control  surfaces.  The  comparison  of  the  two 
time  histories,  therefore,  is  limited  to  checking  initial 
derivatives,  apparent  natural  frequencies,  and  the  damping 
rate. 

Four  linear  models  were  developed,  corresponding  to 
forward  velocities  of  5,  10,  20,  and  25  knots.  Control 
surface  deflections  were  maintained  at  the  values  previously 
mentioned.  The  models  are  designated  S5RS,  S10RS,  S20RS, 
and  S25R5,  reflecting  the  speed  and  rudder  deflection. 
Figures  2.3  and  2.4  show  results  of  the  comparisons  for 
selected  state  variables  for  the  5  and  20  knot  models.  The 
perturbations  applied  to  the  nominal  point  were  identical  in 
all  cases  (see  table  2.3).  The  comparisons  show  excellent 
correlation  between  the  linear  and  nonlinear  models  and 
serve  to  validate  the  linear  models.  In  particular,  the 
initial  derivatives,  the  apparent  natural  frequency  of 
response,  and  the  damping  factors  match  almost  exactly  for 
the  linear  and  nonlinear  models.  Notice  that  the  pitch  rate 
q(t)  (figure  2.3  (c>  and  (d)  and  2.4  (c>  and  (d) >  contains 
two  oscillatory  modes,  reflecting  the  cross  coupling  between 
the  rudders  and  stern  planes  when  the  submarine  has  a 
non-zero  roll  angle.  The  roll  angle  for  the  5  knot  model  is 
-0.6  degrees  and  for  the  20  knot  model,  -8  degrees.  The  A 
and  B  matrices  for  the  four  models  are  presented  in  appendix 
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(a)  Roll  rate  p(t)  far  the  linear  model 


<c)  Pitch  rate  q(t)  for  the  linear  model 


(d>  Pitch  rate  q<t)  for  the  nonlinear  model 
Figure  2.3.  Comparison  of  Linear  and  Nonlinear  5  Knot  Models 
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Linear  and  Nonlinear  5  Knot  Models 
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(a)  Roll  rate  p(t)  -for  the  linear  model 
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(d)  Pitch  rate  q<t>  for  the  nonlinear  model 
Figure  2.4.  Comparison  of  Linear  and  Nonlinear  20  Knot  Models 
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Figure  2.4.  Comparison  o-f  Linear  and  Nonlinear  20  Knot  Models 
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Table  2.3 


Per turbat i ons  Applied  to  Nominal  Points 


State  Variable 
u 

V 

w 

P 

q 

r 

♦ 

e 


Perturbation 

>2.0  ft/sec 
>0.2  ft/sec 

-  0.02  -rt/sec 

-  0.00003  rad/sec 
>  0.00003  rad/sec 

-  0.003  rad/sec 
-0.5  degrees 

-  1.0  degrees 


2.5  Selection  o-f  the  Output  Variables 

Selection  of  the  output  variables  requires  both  a  careful 
study  of  the  A  and  B  matrices  and  determination  of  the 
intent  of  the  controller  design.  Three  control  variables 
are  available  so  that  three  output  variables  can  be  chosen. 
An  autopilot  could  be  designed,  using  the  position  variables 
V  and  z,  or  a  rate  controller  could  be  designed,  using  the 
rate  variables  u,  v,  w,  p,  q,  orr.  The  attitude  variables 
^  and  0  could  bo  included  in  either  design,  depending  on  the 
importance  of  these  variables  to  the  control  system 
desi gner . 

The  philosophy  taken  in  this  thesis  is  that  a  rate 
controller  be  designed  to  control  the  submarine  during 
various  maneuvers.  As  previously  mentioned,  the  submarine 
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mod»l  was  linsarizad  about  a  nonconvent ional  operating  point 
to  ensure  that  the  cross  coupling  o-f  the  control  surfaces 
would  be  captured  in  the  A  and  B  matrices.  The  simplifying 
assumption  is  made  that  the  rate  commands  are  presented  in 
the  form  of  commands  for  w  and  r.  If  this  assumption  were 
not  made,  the  coordinate  transformation  effect  of  the  Euler 
angles  would  require  a  C  matrix  that  was  dependent  on  the 
real  time  values  of  B,  and  ¥,  making  the  C  matrix  state 
dependent.  The  third  output  variable  is  taken  to  be  6,  the 
pitch  angle,  permitting  the  controller  to  accomplish  depth 
changes  without  imparting  a  pitch  angle  on  the  submarine. 
The  reader  should  note  that  w(t)  is  not  an  inertial 
reference  plane  variable,  and  represents  the  true  vertical 
rate  only  when  the  submarine  has  zero  pitch  and  roll 
angles.  Unfortunately,  z(t>  is  not  available  as  a  state 
variable  and  this  discrepancy  must  be  tolerated. 

With  the  output  variables  determined,  and  the  A  and  B 
matrices  calculated,  the  state  space  description  of  the 
submarine  model  is  now  complete  and  takes  the  form 

x<t)  »  A  x<t)  +  B  u<t) 

X<t)  »  C  X (t> ,  <2. 1) 
where  y^(t)  -  C  w(t)  r(t)  e(t> 
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2.6  P«rf oroianc*  Reauirements 


T*iio  parforoianca  raquirements  ar»  imposed  on  the  controller 
design.  First,  the  maximum  crossover  frequency  is  limited 
to  that  o-f  the  submarine's  ability  to  respond  and,  second, 
the  steady  state  error  to  step  commands  and  step 
disturbances  is  to  be  zero. 

The  maximum  crossover  frequency  is  based  on  the  perturbed 
response  of  the  non-linear  model.  Inspection  of  figure  2.5 
reveals  an  average  settling  time  to  within  90%  of  steady 
state  of  60-65  seconds,  leading  to  a  desired  crossover 
frequency  of  0.10  radians/sec. 

Inspection  of  the  perturbed  response  of  all  four  models 
confirms  an  intuitive  feeling  that  the  settling  time 
increases  as  the  submarine  slows,  requiring  that  a  different 
performance  requirement  be  levied  on  each  design. 

The  value  of  0.10  rad/sec  was  declared  to  be  the  maximum 
for  the  fastest  model  <25  knots) ,  and  a  least  squares  curve 
was  fitted  to  the  approximate  time  constants  indicated  by 
the  plots.  A  linear  fit  proved  satisfactory,  giving  a 


correlation  coefficient  of  0.9983  and,  when  transformed  to 
yield  maximum  crossover  frequencies,  produced  the  results  in 


table  2.4. 


Table  2.4 

Croseover  Frequencies  -for  the  Li  near  Mc3dels 

Model  Crossover  Frequency  (rad/sec) 

5  Knot  0. 05 

10  Knot  0.06 

20  Knot  0.08 

25  Knot  0.10 

The  zero  steady  state  error  requirement  is  met  by  placing 
integrators  in  each  o-f  the  three  input  channels.  The 
integrators  are  placed  at  the  input  to  the  plant  because 
this  is  Mhere  the  error  signal  appears.  The  integrators 
will  then  become  a  part  of  the  compensator  which  is  before 
the  plant  in  the  feedback  loop.  As  will  be  seen,  the  use  of 
integral  control  does  not  prevent  the  maKimum  crossover 
frequency  specification  from  being  met. 


2.7  Summary 

This  chapter  has  described  the  origins  of  the  submarine 
model,  briefly  described  the  process  of  producing  a  linear 
model,  and  presented  the  reasoning  by  which  the  output 
variables  were  chosen.  Additionally,  performance 
constraints  were  imposed  on  the  controller  design,  thus 
setting  the  stage  for  analysis  of  the  open  loop  dynamics  of 
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the  plant 


The  next  chapter  will  analyze  the  plant  using  the  method 
o-f  modal  decomposition,  and  present  data  showing  the 
eigenstructure  o-f  the  submarine  linear  models. 
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Chaptar  3 


ANALYSIS  OF  THE  LINEAR  MODEL 


3.1  Introduction 


In  this  chaptsr,  ths  eigenstructure  o-f  the  unaugmented  20 
knot  model  will  be  investigated.  As  previously  stated ,  the 
20  knot  model  was  the  -first  to  be  developed  and  the  only  one 
to  have  a  detailed  analysis  per-formed  on  it. 

For  each  o-f  the  other  three  linear  models  (at  5,  10,  and 
25  knots)  analysis  was  limited  to  inspection  of  the  poles 
and  zeros,  and  producing  singular  value  plots  of  the  open 
loop  plant.  Several  consistency  checks  were  also  performed 
in  an  effort  to  avoid  any  numerical  errors. 

In  the  previous  chapter,  a  state  space  description  of  the 
submarine  linear  model  was  developed  in  the  form 

k(t)  *  A  x<t)  +  B  u(t)  (3.1 

^(t)  ■  C  u(t) .  (3.2 

Prior  to  the  actual  analysis  of  the  linear  model,  it  will  be 


shown  that  the  order  of  the  model  can  be  reduced,  based  on 


th»  z«ro  entries  present  in  the  A  and  B  matrices. 

The  eigenstructure  o-f  the  20  knot  model  is  revealed  by  the 
method  o-f  modal  analysis  C131.  This  method  involves  the 
implicit  application  o-f  similarity  transformations  to  the  A 
matrix y  reducing  it  to  a  diagonal  matrix  whose  entries  are 
the  poles  of  the  open  loop  system.  The  similarity 
transformations  provide  a  means  of  describing  the  state 
space  of  the  linear  system  in  separate  decoupled  modes, 
thereby  yielding  information  as  to  the  controllability  and 
observability  of  the  system. 

This  information,  coupled  with  the  pole~zero  structure, 
provides  the  basis  and  validity  for  the  LQG/LTR  designs  of 
the  next  chapter. 


5.2  Reduction  of  the  Model 


Inspection  of  the  A  matrix  for  the  20  knot  model  (refer  to 
Appendix  A,  model  S20RS)  reveals  zero  entries  in  all 
elements  of  the  last  two  columns.  This  indicates  that  the 
present  values  of  the  states  y  and  z  can  have  no  influence 
on  any  other  state.  In  other  words,  the  present  depth  and 
heading  angle  are  irrel event  to  the  dynamic  response  of  the 
linear  system. 
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Zeros  in  the  last  two  rows  o-f  B  (Appendix  A>  -further 
indicate  that  the  controls  exert  no  direct  in-fluence  on  the 
derivatives  o-f  V  and  z. 

There-fore,  since  the  purpose  o-f  the  controller  is  not 
concerned  with  controlling  either  of  these  variables,  they 
are  removed  from  the  linear  model.  This  is  accomplished  by 
deleting  the  last  two  rows  and  columns  of  A,  and  the  last 
two  rows  of  B,  leaving  an  8  state  system. 


3.3  The  Natural  Modes  of  the  System  • 

Determination  of  the  natural  modes  of  the  28  knot  linear 
model  is  accomplished  by  diagonalizing  the  state  space 
description.  For  any  linear  dynamic  system  without  input  to 
output  direct  coupling,  we  have 

x<t)  *  A  x<t)  +  B  u(t)  (3.3) 

Ji(t)  ■  C  x(t).  (3.4) 

Now  define  a  new  state  vector  z(t)  by  the  relation 

X (t)  »  T  z  (t) ,  (3.5) 

where  T  is  an  as  yet  unspeciiied,  n  x  n,  invertible  matrix. 
Then  we  have 

T  z(t)  -AT  z(t)  +  B  u(t)  (3.6) 

^(t)  »  C  T  z(t).  (3.7) 

Multiplying  (3.6)  on  the  left  by  T~*^,  we  are  left  with 
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z  (t> 


(3.8) 


B 

!• 

a 

a 


i.. 


IL 


T~^  A  T  z<t)  +  T“^  B  u(t) 


y^(t) 


C  T  z<t). 


(3.9) 


I-F  T  is  such  that  T  ^  ^  T  is  diagonal,  then  the  state  vector 
z(t>  de-fines  a  new  state  space  in  which  the  modes  are 
decoupled  and  the  entries  o-f  T  ^  A  T  are  the  eigenvalues  o-f 
A.  Let 


A  =  T”^  a  T.  (3. 10) 

Then  we  have  (3.11) 

Now,  represent  the  T  matrix  by  its  n  column  vectors  v^ ,  v^, 
...,  so  that  equation  3.11  can  be  expressed  as 

A  v.  »  v.X.  for  i  =  1  to  n  (A  *  Cx.l).  (3.12) 

- 1  — X  1  1 

Thus  the  columns  of  T  are  the  eigenvectors  of  A  and  the 
diagonal iz at ion  is  possible  only  whan  the  A  matrix  has 
distinct  eigenvalues. 


The  T  matrix  is  called  the  modal  matrix ,  with  each  column 
of  T  describing  the  motion  of  the  submarine  along  the 
coordinate  axes  of  the  state  vector  components  u,  v,  w,  p, 
q,  r,  and  9,  for  a  particular  mode.  Since  every  possible 
dynamic  response  of  the  submarine  must  consist  of  a  linear 
combination  of  the  decoupled  modes,  analysis  of  the  columns 
of  T  should  provide  the  designer  with  very  useful 
information  regarding  the  submarine's  dynamic  response. 

Unfortunately,  it  is  not  a  simple  matter  to  visualize  or 
characterize  motions  in  8— space,  especially  when  the 
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magnitude  of  the  motions  are  complex  numbers  expressed  in 
various  units. 

Analysis  of  the  modes  of  the  system  is  accomplished  in  two 
steps.  First,  the  A  and  B  matrices  of  the  linear  model  are 
transformed  so  that  all  angular  components  of  the  state 
vector  will  have  units  of  degrees  or  degrees/sec,  as 
appropriate.  Details  of  the  transformations  applied  are  in 
appendix  Bl. 

Secondly,  the  columns  of  the  resulting  modal  matrix  are 
graphed  in  bar  chart  form  by  taking  absolute  values  of  each 
element  of  the  normalized  column  vectors.  The  loss  of  phase 
information  resulting  from  taking  absolute  values  is 
considered  to  be  of  less  importance  than  the  magnitude  of 
the  motion  along  a  particular  state  component. 

The  bar  charts  (figure  3.1)  have  a  vertical  scale  of  0  to 
100%,  reflecting  the  intent  of  displaying  the  relative 
magnitude  of  the  response,  and  the  eigenvalue  corresponding 
to  a  particular  mode  is  noted  below  each  graph.  Note  that 
the  two  columns  corresponding  to  a  complex  eigenvalue  do  not 
produce  unique  modes  when  graphed  in  this  manner.  Complex, 
or  oscillatory  modes  are  indicated  by  the  labeling  and  the 
presence  of  a  complex  eigenvalue. 

It  should  be  noted  at  this  point  that  the  modes  shown 
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Modal  Response  for  model  S2.0P5 


Figure  3.1(a)  Modes  1*  2,  and  3  for  Model  S2QRS 
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Modal  Respon se  for  Model  S20R5 
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Figurs  3. i (b)  Modes  4,  5,  and  7  for  Model  S20R5 
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represent  the  natural  modes  o-f  a  linear  model  o-f  a  submarine 
proceeding  downward,  in  a  port  turn,  at  20  knots.  (Recall 
that  the  nominal  point  specifies  5  degrees  of  rudder  and  1 
degree  on  the  planes).  Thus,  although  the  bar  charts 
provide  a  convenient  means  of  displaying  the  modes  of  a 
linear  system,  in  this  particular  case  they  are  displaying 
the  modes  of  a  system  linearized  about  a  nominal  point  that 
serves  to  further  obscure  any  physical  interpretation.  For 
this  reason,  interpretation  of  the  modes  is  limited  to  the 
following  observations: 

1.  All  eigenvalues,  and  hence  the  open  loop  poles,  are  in 
the  left  half  plane. 

2.  Mode  1  appears  to  represent  the  steady  state  response 
of  the  submarine  in  a  diving  turn  with  constant 
control  surface  deflections. 

3.  Modes  1,  2,  and  3  are  relatively  lightly  damped 

compared  to  the  other  modes.  They  also  have  less  roll 
response  and  higher  pitch  response  than  the  others, 
and  tend  to  indicate  that  the  sail  of  the  submarine 
acts  as  a  damper  in  side  to  side  motions  of  the 
submarine. 

4.  Modes  5  and  6  represent  a  nearly  pure  roll  mode  in 
that  almost  the  entire  response  is  concentrated  in 
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roll  and  roll  rate.  The  inability  to  directly  control 


roll  and  roll  rate  is  re-flected  in  the  oscillatory 
behavior  of  these  inodes. 

5.  Comparison  of  the  magnitudes  for  roll,  pitch,  and  yaw 
rates  for  modes  4  and  8  appears  to  indicate  that  as 
more  yaw  rate  is  introduced,  some  of  the  roll  response 
is  converted  to  pitch  response.  This  is  indicative  of 
the  cross  coupling  that  exists  between  the  stern 
planes  and  the  rudder  when  the  submarine  is  rolling 
and  turning  at  the  same  time. 

The  eigenvalues  and  modal  matrices  for  all  models  are 
contained  in  appendices  B2  through  B5. 


3.4  Controllability  and  Observability 

The  LQG/LTR  design  methodology  provides,  under  certain 
conditions,  guarantees  to  the  control  system  designer 
concerning  gain  and  phase  margins  C83.  It  should  be  noted 
that  the  guarantees  are  not  absolute,  and  exist  only  in  the 
sense  that  the  LTR  phase  of  the  design  process  recovers  a 
loop  shape  that  approaches  that  of  the  Kalman  Filter  design, 
which  does  have  the  robustness  guarantees. 

The  linear  system  must  meet  certain  requirements,  however. 
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before  the  validity  of  the  results  are  assured. 
Specif ical IVf  the  system  must  have  no  unstable  modes  which 


are  not  controllable,  and  no  unstable 

modes 

which 

are 

not 

observable.  If  controllability 

and 

observability 

of 

the 

system  can  be  established,  then 

the 

weaker 

condi tions 

of 

stabi 1 izabi 1 i ty  end  detectability  are  assured. 

When  a  linear  system  can  be  diagonalized,  as  in  the 
present  case,  determination  of  controllability  and 
observability  becomes  a  very  simple  matter.  Additionally, 
even  when  a  system  does  not  meet  the  criteria  for  being 
controllable  or  observable,  the  weaker  conditions  of 
stabi lizability  and  detectability  are  also  readily 
determined.  « 

Recall  that  the  new  state  vector  z  (equation  3.5>  defines 
a  non-physical  state  space  in  which  the  natural  modes  of  the 
system  are  decoupled.  Thus  a  particular  row  of  the  B 
matrix  links  the  input  vector  u  to  a  particular  mode.  Each 
element  in  the  row  then  links  a  particular  input  (in  our 
case  a  control  surface)  to  a  mode.  Therefore,  a  zero  entry 
in  the  (i,j)  position  of  the  T  ^  B  matrix  would  indicate 
that  the  ith  mode  is  not  controllable  by  the  jth  input. 

Similarly,  the  matrix  Q.  I.  equation  3.9  indicates 
whether  a  particular  mode  is  visible  in  the  output. 
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The  20  knot  linear  model  has  non-zero  entries  in  the  T  ^  6 
and  C  T  matrices  (refer  to  appendix  B4)  and  is  therefore 
both  controllable  and  observable,  providing  us  with 
assurances  that  the  LQ6  design  method  to  be  applied  in  the 
next  chapter  will  have  no  difficulties. 


3.5  Poles,  Zeros,  and  Singular  Values 

The  poles  of  the  open  loop  plant  are  the  eigenvalues  of 
the  A  matrix  presented  in  the  previous  section.  As  was 
indicated,  the  plant  is  open  loop  stable,  having  all  left 
half  plane  p'oles. 

Multivariable  transmission  zeros  appearing  in.  the  right 
half  plane  may  present  difficulties  in  an  LQG/LTR  design 
C81.  Fortunately,  the  20  knot  linear  model  has  no 
nixi-minimuffl  phase  zeros,  nor  do  any  of  the  other  models 
(refer  to  Appendix  B6) . 

The  open  loop  poles  for  all  four  models  are  presented  with 
the  modal  information  in  appendices  B2  through  B5,  and  the 
transmission  zeros  for  each  model  in  Appendix  B6. 

Singular  value  plots  of  the  open  loop  models  are  shown  in 
figure  3.2.  It  will  be  noticed  that  integral  control  is  yet 
to  be  added,  and  that  satisfactory  command  following 
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log  (sngulor  value)  20  *  log  (singular  value) 


Model  S5RS 


Model  S10R6 


log  emego  (rod/aec) 

Figure  3.2(a)  Open  Loop  Singular  Values  -for  the 
S  and  10  Knot  Linear  Models 
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performance  will  indeed  require  the  addition  of  integrators 
in  the  loop  transfer  function  matrix.  The  increased  effect 
of  the  control  surfaces  as  speed  increases  can  be  seen  by 
noting  the  increased  dc  gain  for  each  sucessive  model. 

As  a  further  indication  of  the  effect  of  the  control 
surfaces  on  the  outputs,  the  dc  gains  of  the  open  loop 
transfer  function  matrix  for  the  20  knot  model  are  listed  in 
table  3.1.  By  reading  across  for  each  output  variable,  the 
relative  effect  of  the  control  surfaces  can  be  determined. 
The  results  are  as  expected,  with  the  sail  planes  having  the 
most  effect  on  w,  the  rudder  on  r,  and  the  stern  planes  on 
9.  The  gains  for  w  are  significantly  higher  than  for  the 
other  two  outputs,  indicating  a  need  for  scaling,  which  is 
done  in  the  next  chapter. 

Table  3.1.  Input  to  Output  Coupling 


ds 

db 

dr 

w 

11  db 

19  db 

16  db 

r 

-S6  db 

-49  db 

-18  db 

e 

19  db 

-8.1  db 

-3.0  db 
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3.6  A  Further  Example  o-f  th«  Us«-fuln»««  o-f  Modal  Analysis 


This  chapter  on  analysis  o-f  the  linear  model  would  be 
incomplete  without  demonstrating  the  extreme  usefulness  of 
modal  analysis  in  detecting  inconsistencies  in  a  model. 

The  initial  linear  model  of  the  submarine  on  the  CSDL 
computer  contained  an  lith  state  known  as  i).  The  purpose  of 
this  state  was  to  include  the  propulsion  plant  dynamics  and 
was  defined  as  u (actual ) /u (commanded ) . 

Modal  analysis  of  the  model  with  n  included  resulted  in 
eight  modes  essentially  the  same  as  those  depicted  in  figure 
3.1,  and  a  ninth  mode  with  all  response  concentrated  in  u 
and  q.  Furthermore,  this  ninth  mode  had  a  near — zero 
eigenvalue  and  zeros  in  the  corresponding  row  of  the  T~^  B 
matrix. 

From  the  previous  discussion  of  modal  analysis,  we  can  see 
that  this  situation  is  indicative  of  an  uncontrollable  and 
unstable  mode,  thus  rendering  the  LQ6  design  methodology 
invalid.  If,  however,  the  near-zero  eigenvalue  is  taken  to 
be  the  digital  representation  of  a  true  zero  eigenvalue,  and 
the  reasoning  is  applied  that  the  actual  submarine  must  be 
stable  in  forward  velocity,  then  the  facts  imply  an 
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inconsistency  in  the  niadel . 


To  -further  re-fine  this  conclusion,  both  the  linear  and  the 
nonlinear  equations  o-f  motion  were  integrated  over  time, 
using  the  scaled  magnitudes  o-f  the  eigenvector  corresponding 
to  the  unstable  mode.  The  nonlinear  plot  decayed  back  to 
the  local  equilibrium  point  whereas  the  linear  plot 
displayed  an  unforced  response  that  remained  at  the 
perturbed  values. 

This  last  information  clearly  indicated  a  dependency  among 
the  states  of  the  linear  model,  and  the  problem  was  then 
quickly  traced  to  the  treatment  of  the  propulsion  plant  as  a 
constant  rpm  source  for  the  propeller.  Thus  the  commanded  u 
was  being  taken  as  constant  for  any  run,  and  n  represented  a 
constant  multiple  of  u,  producing  the  dependent  state. 

Application  of  the  chain  rule  to  the  system  of  11 
equations  in  11  unknowns  (used  to  calculate  the  A  and  B 
matrices)  reduced  the  order  of  the  system  to  10,  and 
eliminated  the  unstable  state. 

It  is  hoped  that  this  example  may  serve  to  aid  the  reader 
in  the  methodical  elimination  of  similar  problems  in  a 
linear  model. 
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5.7  Summary 


This  chapter  has  described  the  technique  o-f  modal  analysis 
and  its  use  in  determining  the  eigenstructure  and  modal 
composition  o-f  the  state  space  description  of  a  linear 
model . 

Application  of  this  technique  has  enabled  us  to  establish 
the  prerequisites  required  to  pursue  the  LQG/LTR  design 
procedure  to  be  covered  in  the  next  chapter.  These  are  that 
the  open  loop  linear  model  be  detectable  and  stabi 1 izable, 
and  that  the  location  of  any  non-minimum  phase  zeros  be 
determined. 

Finally,  an  example  of  the  usefulness  of  modal  analysis  in 
tracking  down  an  error  in  the  linearization  of  the  nonlinear 
model  was  presented. 
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Chaptar  4 


LINEAR  MZMO  DESIGNS 


4. 1  Introduction 


This  chapter  presents  the  linear  portion  o-f  the  design 
process,  utilizing  the  LQG/LTR  design  methodology  as  the 
MIMO  design  tool. 

The  design  section  begins  with  an  overview  of  the  complete 
step  by  step  LQG/LTR  procedure,  as  tailored  to  conform  to 
the  main  focus  of  this  thesis. 

Augmentation  of  the  submarine  model  dynamics  with 
integrators  will  then  be  discussed,  along  with  a  comparison 
of  open  loop  singular  value  plots  for  the  augmented  and 
unaugmented  20  knot  model . 

Finally,  the  methods  used  to  ensure  the  identical  behavior 
of  the  singular  values  of  the  open  loop  plant  at  both  the 
high  and  low  ends  of  the  frequency  spectrum  will  be 
presented. 
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Testing  of  the  compensator  begins  with  a  comparison  o-f  the 
step  responses  o-f  both  the  linear  and  nonlinear  models,  and 
concludes  with  simulations  o-f  evasive  maneuvers  and  control 
sur-face  saturation  tests. 

All  parameters  used  in  the  design  process  and  many  o-f  the 
design  products  -for  all  four  models  are  contained  in  the 
appendices. 


4.2  The  LQG/LTR  Design  Methodology 

The  multivariable  LQG/LTR  design  methodology  consists  of  a 
four  step  process  £83. 

Step  one  involves  the  development  of  a  low  frequency  model 
of  the  nominal  plant  and  determination  of  the  uncertainties 
present  in  the  model.  It  is  assumed  that  the  frequency 
range  of  interest  for  purposes  of  command  following  and 
disturbance  rejection  is  at  low  frequencies. 

The  uncertainty  in  the  nominal  model,  including  sensor 
noise,  unmodeled  dynamics,  and  certain  actuator  dynamics,  is 
similarly  assumed  to  be  concentrated  at  high  frequencies. 
The  determination  of  what  constitutes  high  and  low 
frequencies  consists  of  fixing  the  maximum  allowable 
crossover  frequency  for  the  nominal  design. 
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In  this  thesis,  the  actual  linear  time  invariant  plant  and 


the  low  frequency  nominal  model  are  taken  to  be  identical , 
and  no  attempt  is  made  to  establish  the  modeling 
uncertainty.  Therefore,  step  one  is  restricted  to  producing 
the  linear  model,  as  was  discussed  in  chapter  2,  and 
determination  of  the  maximum  allowable  crossover  frequency 
for  each  model,  also  discussed  in  chapter  2. 

Step  two  of  the  design  process  establishes  the  low 
frequency  performance  requirements.  The  frequency  domain 
block  representation  of  the  compensated  plant  is  shown  in 
figure  4.1. 

4f““  1  f"’ 

— KD-i - - 


■o 


ecs) 


Kci») 


&u> 


Figure  4.1.  Block  Diagram  of  a  MIMO  Compensated  Plant 


r  <s) 
e(s) 
u(s) 

d(s) 

|<(s) 

6(s) 


reference  signal  or  command  input  vector 
error  signal  vector 
control  input  vector  to  the  plant 
output  vector  of  the  plant 

disturbance  vector  reflected  at  the  plant  output 
compensator  transfer  function  matrix 
(augmented)  plant  transfer  matrix 
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The  trans-fer  matrix  6(s)  is  assumed  to  contain  the  nominal 

low  -frequency  model  o-f  the  submarine  ^(s)  plus  any 

augmented  dynamics  G^<s)  and  is  termed  the  nominal  design 

model.  Thus  G(s)  »  G  (s>  G  (s>.  To  determine  the 
-  -p  -a 

requirements  to  be  imposed  on  the  compensator  trans-fer 
matrix  K(s)  ,  the  overall  trans-fer  function  of  the  closed 
loop  system  is  calculated 

y^<s)*CI.+G<a)K<s)  ]~^d  (s)+CI^^6<s>!<(s>  3“^G<s)  !<(B)r  (s) .  (4.1) 

Good  command  following  requires  that  ^(s)  ~  good 
disturbance  rejection  will  result  if  the  contribution  of 
d(s)  can  be  kept  small.  Here,  s  «  J«*  is  in  the  low  end  of 
the  frequency  spectrum. 

Both  of  these  requirements  can  be  met  if  the  minimum 
singular  values  of  the  matrix  product  6(s)K(s)  are  large 
with  respect  to  unity  at  frequencies  below  crossover. 

Similarly,  the  response  of  the  outputs  to  high  frequency 
effects  can  be  minimized  if  the  maximum  singular  values  of 
G(s)K(s)  are  small  compared  with  unity  at  frequencies  above 
crossover. 

The  combined  effect  of  steps  1  and  2  is  to  place  barriers 
on  the  singular  value  plot  for  6(Jw)|<(Jw)  as  indicated  in 
figure  4.2.  The  high  frequmey  barrier  places  a  robustness 
requirement  on  the  compensator  and  the  low  frequency  barrier 
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is  a  result  o-f  the  command  -following  and  disturbance 
rejection  requirements. 


20  log  <j 


Figure  4.2  Desired  Singular  Value  Relationships 


The  remainder  of  the  design  process  is  concerned  with 
determining  the  transfer  matrix  {<(s>  so  that  the  singular 
values  of  the  open  loop  transfer  matrix  G<Jwlf<(Jw>  will  have 
the  shapes  shown  in  figure  4.2.  This  process  is  known  as 
loop  shaping  and  is  at  the  heart  of  the  LQS/LTR  design 
procedure. 


Initially,  the  Kalman  Filter  methodology  is  applied  to  the 
state  space  description  of  the  nominal  design  model  (nominal 
model  plus  augmentation)  to  produce  a  transfer  matrix  ^p(s) 
that  has  the  desired  loop  shapes.  The  Kalman  Filter  theory 
is  applied  in  a  very  specific  manner  and  should  not  be 
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con-fused  with  optimal  state  estimation  applications. 

To  solve  the  Kalman  Filter  problem,  the  nominal  design 


model  state  space  description, 

x<t)  »  A  K(t)  +  B  u(t)  (4.2) 

^<t)  =  C  x(t>  ,  (4.3) 

is  re-formulated  to  produce  the  somewhat  modi-fied  dynamics 

x(t)  »  A  x(t)  +  L  5,(t)  (4.4) 

^(t)  »  C  x(t)  +  e(t).  (4.5) 


where  ]^(t)  represents  the  process  white  noise, 
and  6(t)  represents  the  measurement  white  noise. 

The  covariance  o-f  these  two  Saussian  signals  is 

covCi|,(t)sl(T)3  =  I&<t-T>,  (4.6) 

and  covC©(t);e(T)3  =  AlS(t~T>  (;i  >  0) .  (4.7) 


The  design  parameters  and  L  are  then  used  to  produce  the 


desired  loop  shapes  o-f  the  trans-fer  matrix  G^p(s)  where 

Gj^p(s)  -  C(Bi-A)”^H,  and 
H  ■  (1/^A)  E  C'. 


(4.8) 

(4.9) 


The  matrix  E  is  the  solution  to  the  Filter  Algebraic 
Riccati  Equation  (FARE) 

0-AE  +  EA'  +  LL'  -  (IZ/^i)  E  C'C  E.  (4.10) 
Fortunately,  the  transfer  matrix  6^p(B)  can  be  approximated 
quite  readily,  providing  that  the  parameter  <<  1,  and  the 
FARE  need  not  be  evaluated  for  each  choice  of  ft.  and  L. 
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It 


can  b«  shown  C8]  that 


ajCGj^pCjw)  J  «  (1/-/A)  <y^CSpQj_(j»)  3,  -for  )l  «  1,  (4.11) 

where  GpQj_(j»)  »  C(si-A)“^L.  (4.12) 

Thus  the  L  matrix  can  be  chosen  in  such  a  way  as  to 
produce  the  desired  loop  shape  and  )t  used  to  adjust  the 
singular  values  up  and  down  to  meet  the  required  crossover 
frequency  criteria. 

Providing  that  CAfLl  is  stabilizable,  and  that  CA,C3  is 
detectable,  any  choice  of  and  L  will  produce  the  following 
guaranteed  propc»rties  for  6|^p(s)s 

1.  Closed  loop  stable 

2.  i^obustnesss 

<yjCI.+Gj^p(j»)  3  !h  1  (4.13) 

<y^CI+Gj^p'*^(j»)3  a  1/2  (4.14) 

3.  Infinite  upward  gain  margin 

4.  6  db  downward  gain  margin 

5.  Phase  margins  of  ±  60* 

The  final  step  in  the  LQ6/LTR  design  procedure  involves 
the  "recovery"  of  the  loop  shapes  of  G^p(s)  by  the 
compensated  plant  transfer  matrix  G(s)|<(s).  This  is 
accomplished  by  solving  the  Control  Algebraic  Riccati 
Equation  (CARE) 


0  »  -  K  A  -  A'K  -  qC'C  +  K  B  B'K  ;  q  >  0  (4. 15) 
using  the  design  parameter  q,  and  de-fining  the  control  gain 
matrix  G  by 


B'K. 


(4. 16) 


For  the  solution  to  the  CARE  to  be  valid,  we  must  have 
[A,B3  stabilizable  and  CA,C3  detectable.  Furthermore,  the 
nominal  design  plant  must  not  have  any  non-*minimum  phase 
zeros. 


The  control  gain  matrix  6  and  the  filter  gain  matrix  H 
(4.9),  when  calculated  using  the  above  procedures,  define  a 
special  type  of  compensator  K[^p^(s)  known  as  a  Model  Based 
Compensator  (figure  4.3).  This  type  of  compensator  differs 
from  other  LQ6/LTR  compensators  only  in  the  manner  in  which 
the  control  and  filter  gain  matrices  are  calculated. 


Ccrttrci 


Figure  4.3.  The  Model  Based  Compensator 


The  state  space  description  of  the  (model  based) 
compensator  is  then  given  by 


z(t>  «  <A-B  B-H  C)  z(t>  -  H  Bit) 
u<t)  *  -G  2 <t) , 


1^. i/t 


(4.  18) 


It  can  be  sho*«n  that  the  singular  values  a-f  G(s)K^^p^(s)  at 
frequencies  below  crossover  converge  to  those  of  G^p<s>  as 
the  design  parameter  q  -»  m,  providing  that  the  plant  is 
fflinifflum  phase  C81.  At  frequencies  above  crossover,  an  extra 
pole  of  roll-off  is  produced  by  the  recovery  phase,  further 
enhancing  the  high  frequency  robustness.  Thus  the  loop 
shape  of  ^p(s>  is  recovered  and  the  resulting  controller 
will  have  the  desired  performance  characteristics  described 


earlier. 


4.3  Augmented  Dynamics 


The  dynamics  of  the  submarine  model  are  augmented  by 

placing  integrators  in  each  of  the  three  control  channels. 

This  is  accomplished  by  defining  an  augmentation  plant  B^(s) 

whose  state  space  description  i  '  simply 

A  a  0,  B  «  C  »  I, 

-a  — ’  —a  —a  — ’ 

with  all  matrices  being  3x3. 


be 


I  I 


Gt-i) 


Figure  4.4.  Inclusion  of  the  Augmented  Dynamics 

Then  the  nominal  low  -frequency  model  and  the  augmentation 
dynamics  are  combined  by  per-forming  a  state  space 
multiplication,  -Forming  G(s>  as  shown  in  figure  4.4,  Note 
that  the  physical  input  to  the  plant  is  now  labeled  to 
distinguish  it  from  the  output  of  the  compensator  u(s) . 
Although  the  augmentation  dynamics  will  eventually  be 
lumped  with  the  compensator,  they  are  kept  separate  until 
the  LQG/LTR  design  procedure  is  complete.  Figure  4.5  shows 
a  comparison  of  the  singular  yalues  of  the  unaugmented  and 
augmented  20  knot  model.  As  can  be  seen,  adding  the 
integrators  at  the  plant  input  produces  a  60  db  gain 
increase  at  .001  rad/sec. 


2.4  Kalman  Filter  Desi< 


In  the  overview  of  the  LQG/LTR  design  methodology,  it  was 


-  61 


log  omega  (rod/aec) 

(a)  Unaugmented  plant 


(b)  Plant  augmented  with  integral  control 

Figure  4.5.  Singular  Values  for  the  Unaugmented  and 
Augmented  20  Knot  Model 


62  - 


stated  that  the  singular  values  o-f  the  Kalman  Filter 
trans-fer  -Function  matrix  are  closely  approximated  by  the 


singular  values  o-f  (l/V>*.)GpQj^<  je> .  Furthermore, 

can  be  easily  calculated  -for  each  choice  o-f  L,  simpli-fying 

the  iterative  nature  o-f  the  design  process. 


To  satis-fy  the  loop  shaping  requirements  represented  by 
the  low  and  high  -Frequency  barriers  shown  in  -Figure  4.2,  it 
is  help-ful  i-f  the  maximum  and  minimum  singular  values  o-f 
are  identical  at  low  and  high  -frequencies. 
There-fore,  the  choice  of  L  is  based  on  this  philosophy. 


Recall  that  G(s>  »  6  (s)G  (s>  (section  4.3)  and  define  a 
-  ~a  -p 

state  space  representation  for  6(s>  by  the  relation 

G<s)  =«  C<si-A>“^B.  (4.19) 

Then  the  matrices  A  and  C  can  be  partitioned  into 


0 


A 

-P 


C  0 


Cp 


(4.20) 


and  similarly  for  sI-A  and  its  inverse 


sI-A 


r.i 

0 

i/s 

0 

_ L_J 

sI-A 
- P 

(SI.-A)  '  « 

(sI-A  )'*^B  /B 
_ - P  -P 

(si-A)”' 

(4.21) 


At  low  frequencies,  sI-A  «  -A  and  (sI-A  )~^  «  -A 

- P  ~P  - P  -p 

Recall  that  A  ^  exists  since  A  has  distinct  and  non-zBro 
-P  -P 

eigenvalues.  We  now  partition  the  L  matrix  into  and 
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so  that,  as  «a  ->  w. 


C  *  <C  C  ') 
“P  ~P-P 


(4.26) 


-C  B  L./»2 

-p-p-1 


I/. 


(4.27) 


The  required  inverses  can  be  shown  to  exist  -for  the  models 

used  via  numerical  means.  Additionally,  whenever  C  is  such 

-P 

that  distinct  states  are  extracted  -from  the  state  vector, 
the  matrix  C  C  '  is  always  diagonal  and  hence  invertible. 


The  above  method  o-f  constructing  the  L  matrix  provides  the 
designer  with  a  guarantee  o-f  identical  behavior  of  the 
singular  values  of  the  Kalman  Filter  transfer  matrix  for*  low 
and  high  frequencies.  Unfortunately,  the  shape  of  the 
singular  values  at  frequencies  near  crossover  is  not 
controlled,  and  significant  differences  may  exist  between 
the  maximum  and  minimum  singular  values  in  the  crossover 
region.  Figure  4.6  is  a  plot  of  the  singular  values  of 
for  the  L  matrix  constructed  as  in  equations  4.23 
and  4.26.  Although  the  singular  values  match  at  high  and  low 
frequencies,  a  large  separation  exists  between  the  maximum 
and  minimum  crossover  frequencies. 


To  control  the  separation  of  the  singular  values  at 
frequencies  near  crossover,  it  is  necessary  to  investigate 
the  magnitudes  of  the  elements  of  the  matrix  transfer 
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20  *  log  (singular  value) 


function  ( j«i>)  over  a  frequency  range  including  the 
crossover  frequency,  and  apply  scaling  to  the  matrix  to 
achieve  a  tight  crossover  pattern.  The  magnitudes  of  the 
elements  of  the  matrix  transfer  function  are  plotted  in 
figure  4,7  for  each  input  to  output  function.  Each  of  the 
plots  represents  the  coupling  from  the  three  controls  to  a 
single  output.  The  curves  are  fairly  smooth  except  for 
figure  4.7(a),  which  shows  the  coupling  from  the  controls 
ds,  db,  and  dr  to  the  output  w.  The  desired  crossover  is  at 
«i  s  0.100,  or  log  w  a:  -1.00,  and  figure  4.7(a)  displays  both 
an  increase  in  coupling  from  dr  and  a  decrease  in  coupling 
from  db  in  this  area.  Referring  back  to  table  3.1,  it  was 
observed  that  the  dc  gains  for  w  were  significantly  higher 
than  for  r  and  6.  Both  of  these  facts  tend  to  indicate  that 
the  matrix  entry  corresponding  to  w  should  be  scaled 
down.  A  comparison  of  the  magnitudes  of  the  transfer 
matrices  in  this  manner  for  all  four  submarine  models 
resulted  in  the  following  choice  for  the  C  matrix. 


C 

-P 


0  0  .1  0  0  0  0 

0  0  0  0  0  1  0 

0  0  0  0  0  0  0 


(4.28) 


The  vast  improvement  in  the  behavior  of  the  singular 
values  near  crossover  can  be  seen  in  figure  4. 10(a>,  a  plot 
of  the  singular  values  of  GpQ^(s)  for  the  20  knot  model 
using  the  new  C  matrix. 
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A  more  detailed  discussion  o-f  output  variable  scaling  for 
the  purpose  of  shaping  the  singular  values  at  frequencies 
near  crossover  can  be  found  in  C14]  and  CiSl. 

Once  the  L  matrix  has  been  determined «  the  choice  of  the 
parameter  jk.  becomes  a  simple  matter  of  moving  the  singular 
value  plots  up  or  down  until  the  desired  crossover  frequency 
is  obtained.  Refer  to  table  4.1  for  a  listing  of  the 
particular  values  used  for  ji.  for  each  of  the  models  during 


the  Kalman  Filter  design 

process. 

The  Kalman  Filter  gain 

matrices  are  contained  in 

appendix 

Cl. 

Table  4.1. 

• 

Val ues 

used  for 

-4 

Model 

& 

S5R5 

.04 

S10R5 

.05 

S20R5 

in 

8 

• 

• 

S2SRS 

.04 

4.5  Completing  the  LQG/LTR  Design 

As  was  indicated  in  the 

overvi cw 

of  the 

LQG/LTR  design 

procedure,  once  the  Kalmar 

1  Filter 

design 

is  complete,  the 

remainder  of  the  design 

process 

is  quite 

straightforward , 

requiring  only  a  choice  of  the  parameter  q.  Recall  that  our 
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Figure  4.8.  Design  Summary  -for  the  5  Knot  Model 
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(a)  Kalman  -filter  open  loop  G(-fol> 


(b)  Kalman  -filtcnr  open  loop  6(kf) 
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(c>  Recovered  open  loop  transfer  function 
Figure  4. 10.  Design  Summary  for  the  20  Knot  Model 
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submarine  models  did  not  have  any  low  -frequency  transmission 
zeros.  A  value  o-f  q  -  100.19  was  used  -for  all  models, 
producing  the  control  gain  matrices  in  appendix  C2. 

The  complete  design  sequence  is  summarized  in  -figures  4.8 
through  4.11,  the  singular  value  plots  o-f  <s) ,  ^p(s)  , 
and  6<b)K(s)  -for  each  o-f  the  -four  models.  The  maximum  and 
minimum  crossover  frequencies  for  the  final  loop  transfer 
function  matrix  CG(s)K<s)]  are  summarized  in  table  4.2. 

Table  4.2.  Final  Crossover  Frequencies  for  G(s>K(s) 


Model 

“min 

“max 

GSRS 

.01A 

.050 

S10RS 

.020 

.0A8 

S20R5 

.029 

.078 

S2SR5 

.024 

.079 

4. A  The  Closed  Loop  System 

Prior  to  beginning  the  testing  phase  of  the  compensator 
design,  properties  of  the  closed  loop  plant  will  be 
investigated. 


The  state  space  representation  of  the  closed  loop  system 
can  be  written  down  by  inspecting  figures  4.1  and  4.3.  Let 


^(t)  represent  the  state  of  the  nominal  design  model  and 


z(t)  the  state  of  the  compensator, 
system  can  be  described  by 


• 

• 

x(t) 

A 

-B  G 

m 

z(t) 

H  C 

A-B  G-H  C 

Then  the  closed  loop 


• 

X  (t) 

0 

z  (t) 

-H  C 

• 

3i<t) 


X  (t) 

z<t) 


(4.29) 


The  poles  and  zeros  for  the  closed  loop  system  are 
contained  in  appendix  C3.  All  poles  are  in  the  left-half 
plana  so  that  the  system  is  in  fact  closed  loop  stable. 


By  setting  d(s)  equal  to  zero  in  equation  4.1,  it  is  seen 
that  the  singular  values  of  the  closed  loop  plant  should  be 
very  near  unity  (zero  db  on  a  log  plot)  from  dc  up  to  the 
crossover  frequency,  and  then  fall  off  above  crossover. 
This  is  depicted  in  figures  4.12  and  4.13,  the  closed  loop 
singular  value  plots  for  all  four  models. 


4.7  Testing  of  the  Compensated  Submarine  Model 

Testing  of  the  LQG/LTR  model  based  compensator  design  was 
accomplished  by  providing  the  computer  program  with  a  data 
file  containing  time  sequenced  command  inputs  and  then 
integrating  either  the  linear  or  nonlinear  equations  of 
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iog  (alngulor  value)  20  *  log  (Angular  value) 


motion.  The  command  inputs  for  each  test  are  superimposed 
on  the  output  variable  time  histories  to  indicate  the  time 
that  the  command  was  applied  and  also  to  provide  an  implicit 
error  history. 

Results  are  shown  for  the  20  knot  model  only  as  it  enjoyed 
the  most  exhaustive  testing.  Check  runs  were  made  for  th'' 
other  models  and  displayed  similar  results. 


4.8  Comparison  of  Linear  and  Nonlinear  Simulations 

The  initial  testing  consisted  of  a  comparison  of  the 
responses  of  the  linear  and  nonlinear  equations  of  motion  to 
step  inputs.  Figure  4.14  is  representative  of  this  stage  of 
testing  and  shows  the  time  histories  of  the  three  output 
variables  (w,  r,  and  9)  and  the  three  control  surfaces  when 
the  submarine  model  is  subjected  to  step  inputs  in  w  and  9. 
For  this  plot*  the  initial  values  of  the  command  inputs  were 
set  to  the  nominal  values  for  the  20  knot  model,  with  the 
step  changes  being  applied  at  t  50  seconds,  and  removed  at 
t  >  100  seconds. 

The  reader  should  note  the  coupling  that  exists  between 
the  stern  and  fairwater  planes  as  they  deflect  in  opposite 
directions  (as  they  should)  in  response  to  the  pitch  command 
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the  pitch  command 


(■figure  4.14  J  and  1).  Additionall/f 
completely  dominates  the  response  initially  and  the  command 
in  w  has  no  e-f-fect  until  the  pitch  error  decreases.  This 
should  not  be  the  case  i-f  the  inertial  variable  z  was  used 
in  place  o-f  w,  although  any  demonstration  of  this 

supposition  will  have  to  wait  until  the  computer  model  is 
changed. 

Figure  4.14  also  displays  the  effects  of  the  cross 
coupling  that  exists  between  yaw  rate  and  pitch,  as 
indicated  by  the  variation  in  yaw  rate  (r)  (figure  4.14  (e) 
and  (f))  and  the  rudder  deflection  (figure  4.14  (m)  and  (n) ) 
at  the  time  when  the  step  command  is  applied  in  6  (figure 
4.14  (g)  and  (h)).  This  is  a  result  of  both  the 
unconventional  operating  point  that  the  model  was  linearized 
about  and  the  non— zero  roll  angle.  Recall  that  the  nominal 
point  reflects  a  diving  turn  so  that  a  roll  angle  is  present 
for  this  maneuver. 

The  main  objective  of  this  test  was  to  determine  the 
extent  of  agreement  between  the  linear  and  nonlinear 
compensated  models  in  order  to  establish  the  validity  of 
both  the  compensator  design  and  the  computer  software  being 
used  for  the  simulations.  The  extremely  close  agreement 
between  the  time  histories  for  the  linear  and  nonlinear 


models  displayed  by  figure  4.14  thus  establishes  the 


validity  and  permits  further.  All  further  simulations  are 
performed  using  the  nonlinear  computer  model. 


4.9  Further  Simulation  of  the  Nonlinear  Model 


Having  established  the  validity  of  the  compensator  design 
by  successful  comparison  of  the  linear  and  nonlinear 
simulations,  the  next  step  is  to  examine  such  factors  as 
symmetry,  multiple  commands,  and  control  surface 
saturation. 

The  degree  of  symmetry  present  in  the  submarine  model  was 
evaluated  by  commanding  a  turn  first  in  one  direction  and 
then  in  the  opposite  direction.  The  results  are  shown  in 
figure  4.15  and  reveal  that  even  with  the  unconventional 
operating  point  used  in  producing  the  linear  model, 
remarkable  symmetry  exists  in  the  expected  state  variables. 
The  roll  angle  (^)  time  history  is  included  in  this  figure 
to  display  the  submarine's  tendency  to  lean  into  a  turn.  A 
rather  curious  phenomenon  is  also  displayed  in  that  the 
submarine  pitches  up  initially  when  commanded  to  turn.  This 
trait  reportedly  exists  in  an  actual  submarine  and  was  also 
observed  on  the  real  time  simulation  facility  mentioned  in 
the  introduction  to  chapter  2.  Finally,  notice  that  the 
performance  of  the  controller  begins  to  degrade  at  about  135 
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Figure  4.14.  Comparison  of  the  Linear  and  Nonlinear  Simulations 
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(g)  Pitch  angle  theta(t)  -for  the  linear' model 
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(i)  Stern  plane  de-flection  -for  the  linear  model 
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(J)  Stern  plane  de-flection  -for  the  nonlinear  model 
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(k)  Fairwater  plane  de-flection  for  the  linear  model 
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(1)  Fairwater  plane  deflection  for  the  nonlinear  model 
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Figure  4.14.  (Cont'd) 
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seconds  as  the  forMard  velocity  reaches  337i  below  the 


nominal  point,  indicating  that  gain  scheduling  is 
necessary. 

The  multiple  command  test  was  accomplished  by  simulating 
an  evasive  maneuver.  The  command  inputs  are  applied  at 
dif-ferent  times  and  simulate  -first  a  diving  turn  followed  by 
a  recovery  of  the  initial  conditions.  The  results  of  this 
test,  shown  in  figure  4.16,  display  the  ability  of  the 
controller  to  respond  to  commands  in  both  yaw  rate  and 
pitch.  Again  we  see  that  the  pitch  command  has  significant 
effect  on  the  yaw  rate  due  to  the  cross  coupling.  Also 
displayed  is  the  inability  of  the  sail  planes  to  control  w 
in  the  presence  of  pitch  commands.  The  sail  planes  do, 
however,  aid  the  stern  planes  in  the  initial  response  to  a 
pitch  command  by  deflecting  in  the  opposite  direction,  as  is 
desired.  Note  the  loss  of  control  in  w  at  about  75  seconds 
when  the  sail  planes  saturate. 

To  fully  display  the  behavior  of  the  compensated  nonlinear 
model  during  periods  of  control  surface  saturation,  the 
reference  inputs  for  w  and  9  used  in  the  previous  test  were 
increased  significantly  in  magnitude  and  the  simulation 
repeated.  The  results  are  presented  in  figure  4.17  and 
display  a  loss  of  control  during  saturation  along  with 
periods  of  lightly  damped  oscillatory  response.  Although 
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Figure  4. IS.  Yan  Rate  Symmetry  Test 
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(a)  Forward  velocity  u(t) 
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(d>  Pitch  angle  9(t> 

Figure  4.17.  Control  Surface  Saturation  Test 
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(g)  Rudder  de-flection 


Figure  4.17.  (Cont'd) 
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the  command  inputs  are  removed  at  iSO  seconds,  the  errors 


don't  return  to  zero  until  nearly  300  seconds.  Q-f 
particular  note  is  the  constant  error  in  m  during 
saturation.  This  can  be  seen  to  be  caused  by  the  sail 
planes  since  the  error  in  w  begins  to  decrease  the  instant 
the  sail  planes  come  out  of  saturation.  Also  note  that 
although  a  25  degree  error  exists  in  pitch  (the  pitch 
command  was  ->50  degrees)  at  60  seconds,  the  stern  planes  are 
only  slowing  increasing  in  deflection.  The  large  control 
surface  deflections  have  slowed  the  submarine  to  nearly  9 
knots  by  this  time,  however,  accounting  for  the  decreased 
control  gain.  Observe  that  the  submarine  speed  rapidly 
decreases  when  the  rudder  saturates,  but  slowly  iecr eases  in 
speed  past  100  seconds,  even  though  the  sail  planes 
saturated. 


4. 10  Summary 

This  chapter  has  presented  an  overview  of  the  LQB/LTR 
design  methodology  and  then  the  application  of  the 
methodology  to  the  design  of  a  compensator  for  the  submarine 
model . 

Compensator  designs  were  developed  for  all  four  linear 
models  of  the  submarine,  providing  the  information  necessary 
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to  apply  a  nonlinear  curve  fit  to  the  compensated 
parameters,  laying  the  groundwork  for  the  gain  scheduling 
algorithm  in  the  next  chapter. 

Time  histories  for  the  20  knot  model  were  presented  that 
further  validated  the  linearization  of  the  nonlinear 
equations  of  motion  and  displayed  the  ability  of  the 
compensator  design  to  control  the  submarine  nonlinear  model 
as  long  as  the  forward  velocity  remained  close  to  the 
nominal  point. 

Finally,  the  loss  of  control  that  can  result  from 
saturation  of  the  control  surfaces  was  demonstrated. 
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Chaptar  5 


NONLINEAR  MIMO  DESIGN 


5. 1  Introduction 


It  is  well  known  that  drag  and  lift  forces  on  a  body  vary 
as  the  square  of  the  velocity  1161.  Therefore,  a 
compe»nsator  designed  for  a  particular  speed  should  not  be 
expected  to  provide  optimum  performance  over  a  widely 
varying  speed  range. 

This  chapter  demonstrates  the  technique  of  gain  scheduling 
as  a  method  of  introducing  the  inherent  nonl ineari ties  due 
to  velocity  into  the  compensator  design. 

The  algorithm  used  to  implement  the  gain  scheduling  is 
presented,  along  with  representative  nonlinear  simulations. 


5.2  The  Bain  Scheduling  Algorithm 


In  the  previous  chapters,  linear  models  of  the  submarine 
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dynamics  were  developed  -for  -four  di-fferent  speeds «  and  an 
LQG/LTR  design  performed  on  each  model.  The  products  of  the 
design  effort  were  the  Kalman  Filter  and  Control  gain 
matrices  contained  in  Appendix  Cl. 

The  specifics  of  the  computer  implementation  of  the  model 
based  compensator  require  that  the  compensator  be  defined  by 
three  matrices,  A-B  G-H  C,  6,  and  H  (refer  to  equations  4. 17 
and  4. IG) .  As  a  result,  the  gain  scheduling  algorithm  must 
produce  the  required  coefficients  to  calculate  the 
individual  entries  for  these  matrices. 

The  fact  that  lift  and  drag  forces  vary  as  the  square  of 
the  velocity  indicates  the  choice  of  a  polynomial  least 
squares  algorithm  to  produce  the  required  coefficients. 
Additionally,  application  of  a  least  squares  algorithm  to 
matrices  as  large  as  11  x  11  requires  that  a  computer  be 
used.  The  fortran  program  in  Appendix  D1  is  an  adaptation 
of  the  vector  based  program  developed  by  A.  Miller  C171  that 
will  accommodate  square  and  non-square  matrices  up  to  order 
11. 

The  program  calculates  correlation  coefficients  for  each 
coefficient  produced,  providing  a  determination  of  how  good 
the  approximation  is.  As  expected,  a  linear  fit  (polynomial 
of  order  1)  produced  very  poor  correlation.  A  second  order 
curve  fit  produced  correlation  coefficients  averaging  0.96, 
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with  a  third  order  -Fit  only  marginally  better.  Since 
implementation  o-F  gain  scheduling  would  require  167  *  n 
multiplications  and  187  »  n  additions,  where  n  »  the  order 
of  the  polynomial,  a  minimal  order  polynomial  is  desired. 
Thus  a  second  order  polynomial  was  used  to  calculate  the 
coefficients.  The  results,  along  with  the  correlation 
coefficients,  are  presented  in  Appendix  D2. 


The  fortran  program  implementing  the  submarine  model  at 
CSOL  was  then  modified  to  permit  the  coefficients  for  the 
A-B  G^-H  C,  G,  and  H  matrices  to  be  read  in,  and  new  values 
for  these  matrices  calculated  for  each  iteration  during 
integration  of  either  the  linear  or  nonlinear  equations  of 
motion.  To  calculate  a  particular  entry  for  one  of  the 
matrices,  say  the  (i,j>  element  of  the  H  matrix,  the  current 
forward  velocity  u<t)  is  first  converted  to  knots  • 
Then,  if  c.  .  c.  .  and  c.  .  _  are  the  coefficients 
calculated  by  the  gain  scheduling  algorithm  for  that  element 
of  the  H  matrix,  the  updated  value  is  given  by 


c.  .  _  +  u,  (c.  .  ,  u,  (c.  .  -)) 

i,jl,0  k  i,j,l  k  i,j,2 


(5.  1) 


Note  that  the  order  of  multiplication  and  addition  has  been 


arranged  to  require  the  minimum  amount  of  calculation. 


The  fact  that  the  computer  implementation  of  the  submarine 
model  did  not  provide  for  propeller  rpm  to  be  varied  was 
overcome  by  setting  the  rpm  to  the  final  speed  and 


introducing  the  initial  speed  into  the  initial  conditions. 

5.5  Testing  o-f  the  Nonlinear  Compensator 

Although  the  above  method  o-f  overcoming  the  constant  rpm 
constraint  o-f  the  model  permitted  simulation  of  gain 
scheduling,  the  flexibility  of  the  simulation  was  somewhat 
limited.  Only  one  speed  excursion  could  be  accomplished 
during  any  single  run,  with  the  propeller  always  rotating  at 
a  constant  rpm. 

Figure  5.1  simulates  changing  depth  without  imparting  a 
pitch  angle  to  the  submarine  and  provides  an  excellent 
example  of  both  the  usefulness  of  w(t}  as  a  state  variable 
and  the  increase  in  control  surface  gain  produced  by  the 
gain  scheduling  algorithm.  The  time  history  of  the  sail 
planes  <db}  indicates  their  dominant  role  in  this  maneuver. 
Although  the  command  in  w(0.5  ft/sec)  is  attained  quite 
early  at  60  seconds,  the  submarine  is  still  slowing  and  the 
nonlinear  compensator  increases  the  sail  plane  deflection 
accordingly.  The  second  command  in  w,  at  275  seconds, 
produces  the  same  magnitude  error  signal,  but  results  in  a 
much  larger  initial  deflection  of  the  sail  planes  due  to  the 
lo*«er  speed.  The  error  in  w  is  seen  to  stay  constant  and 
very  near  zero  during  the  sail  plane  movement. 
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(g)  Rudder  deflection 


Figure  3.1.  (Cont'd) 
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Th»  n»xt  two  simulations  re-^lect  an  attampt  to  further 
define  the  nature  of  the  cross  coupling  that  exists  between 
pitch  angle  B  and  yaw  rate  r.  Both  tests  have  initial 
conditions  corresponding  to  the  nominal  point  for  the  5  knot 
model  with  the  final  spacHi  equal  to  the  nominal  speed  for 
the  25  knot  model.  Command  inputs  were  applied  as  step 
signals  that  corresponded  to  the  nominal  values  for  the 
three  output  variables  for  the  10,  20,  and  25  knot  models. 
The  step  inputs  for  the  10  and  20  knot  nominal  points  were 
timed  so  as  to  occur  simultaneously  with  the  submarine 
attaining  the  forward  velocity  appropriate  to  that  nominal 
point. 

% 

In  figure  5.2,  the  submarine  is  allowed  to  settle  for  a 
short  time  at  the  20  knot  nominal  conditions  before  the 
final  step  change  is  applied.  In  figure  5.3,  however,  the 
last  step  change  is  applied  as  soon  as  the  appropriate 
velocity  is  reached.  Thus  the  two  time  histories  are 
identical  up  to  about  35  seconds.  A  comparison  of  the  two 
sets  of  time  histories  reveals  that  the  cross  coupling 
between  yaw  rate  and  pitch  angle  is  not  minimized  in  the 
second  test,  although  this  might  be  expected  since  the 
submarine  should  be  experiencing  an  attitude  very  similar  to 
that  for  which  the  compensators  were  designed.  Instead, 
although  the  curves  appear  smoother  in  the  second  test,  a 
close  inspection  of  the  errors  and  the  control  surface 
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Figure  5.3.  Yaw  Rate  and  Pitch  Angl 
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de-flections  reveal  that  the  degree  o-f  cross  coupling  is  a 
function  of  the  yaw  rate  error  at  the  time  when  a  step 
change  is  applied.  In  figure  5.2(c),  the  error  in  the  yaw 
rate  when  the  third  step  is  applied  is  approximately  0.003 
rad/sec  whereas,  in  figure  5.2(c),  it  is  nearly  twice  as 
large.  The  result  is  a  larger  overshoot  for  all  three 
outputs  and  an  increased  rudder  deflection.  Furthermore, 
although  the  third  step  change  was  applied  50  seconds 
earlier  in  the  second  test,  the  errors  at  200  seconds  are 
larger  than  for  the  first  test. 

Time  did  not  permit  further  investigation  of  the  cross 
coupling  present  in  the  submarine  model  simulations.  It 
should  prove  informative,  however,  to  compare  the 
simulations  of  figures  5.1,  5.2,  and  5.3  to  identical 
simulations  for  submarine. models  linearized  about  a  straight 
and  level  trajectory. 

The  last  test,  shown  in  Figure  5.4,  illustrates  a  speed 
increase  from  5  to  25  knots  with  all  commands  set  to  zero. 
This  simulation  reveals  an  oscillatory  response  not  present 
in  any  of  the  simulations  presented  so  far.  It  occurred 
consistently  for  all  tests  of  the  nonlinear  compensator 
involving  a  speed  increase  to  approximately  30  knots  and 
having  significant  time  for  settling  out  to  steady  state. 
It  should  be  noted  that  the  oscillations  are  quite  small  in 


Amplitude  and  are  very  lightly  damped. 

Although  the  cause  a-f  the  oscillations  was  not  determined, 
some  phase  lag  appears  to  be  present  in  the  stern  plane 
de-flection  compared  to  the  error  in  6.  This  indicates  the 
requirement  for  more  data  points  to  accurately  predict  the 
model *s  behavior  at  higher  speeds. 

5.4  Summary 

This  chapter  discussed  the  motivation  for  including  the 
nonlinear  aspects  of  the  submarine  model's  response  * i nto  the 
compensator  design.  The  technique  of  gain  scheduling  was 
introduced  as  the  method  by  which  this  could  be 
accomplished,  and  the  specific  algorithm  used  was 
presented. 

The  first  gain  scheduling  simulation,  figure  5.1, 
highlights  the  application  of  this  technique  in  the  time 
history  of  the  sail  planes  (figure  5.1(f)).  Simulations 
using  the  full  nonlinear  controller  were  also  presented  that 
further  demonstrated  the  cross  coupling  present  in  the 
submarine  model. 
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Figure  3.4.  High  Speed  Oscillations  Produced  by 
Gain  Scheduling 
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Chaptar  6 


SUMMARY  AND  DIRECTIONS  FOR  FURTHER  RESEARCH 


&■ 1  Summary 

This  thssis  has  pressnted  a  multivariable  control  design 
example  consisting  of  the  -follomiing  steps: 

1.  Four  linear  models  of  a  full  size  submarine  were 
developed  ^using  a  computer  implementation  of  the 
linear  and  nonlinear  equations  of  motion. 

2.  The  resulting  models  were  reduced  in  order  by 
inspection  of  the  A  and  B  matrices  and  subjected  to 
modal  analysis  to  determine  their  suitability  for  the 
LQ6/LTR  design  procedure. 

3.  Response  characteristics  of  the  open  loop  nonlinear 
model  were  used  to  establish  guidelines  for 
performance  specifications  and  additional  dynamics 
were  included  in  the  models  in  the  form  of  integrators 
in  each  input  channel. 
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4.  The  controller  was  designed  using  the  LQG/LTR  combined 
time  and  -frequency  domain  methodology  as  -formulated  by 
Stein,  Doyle,  et.al.  Loop  shaping  techniques  were 
independently  developed  that  provided  identical 
behavior  o-f  the  singular  values  at  both  ends  o-f  the 
frequency  spectrum  for  linear  models  using  integral 
control . 

5.  A  nonlinear  capability  was  added  to  the  controller 
design  using  the  technique  of  gain  scheduling.  A 
second  order  polynomial  was  used  to  produce 
coefficients  that  enabled  prediction  of  the 
cbmpensator  matrices  for  nominal  points  not  modeled. 


6.2  Some  Conclusions  and  Directions  for  Further 
Research 


Modal  analysis  should  be  used  as  a  first  step  in  any 
multivariable  controller  design.  It  not  only  provides  all 
of  the  necessary  information  for  proceeding  with  the  design, 
but  also  provides  invaluable  reference  material  for 
determining  the  cause  of  any  anomalies  in  the  behavior  of 
the  model . 


The  techniques  used  in  this  thesis  to  match  the  singular 


values  o-f  the  Kalman  Filter  trans-fer  matrix  are  simple  and 
straight-forward.  Un-f  ortunately ,  they  only  apply  when 
certain  o-f  the  matrices  used  are  invertible.  An  extension 
of  this  method  to  cover  the  case  of  .noninvertible  matrices 
using  a  perturbation  matrix  would  provide  a  useful  and 
general  tool  to  the  control  system  designer. 

The  extreme  usefulness  of  singular  value  characterizations 
for  multivariable  systcxns  was  demonstrated  in  this  thesis. 
The  concept  is  an  easily  understood  extension  of  the 
familiar  Bode  plots  and  provides  a  convenient  means  of 
describing  and  then  ensuring  the  attainment  of  performance 
requirements  for  multivariable  systems. 

The  cross  coupling  between  yaw  rate  and  pitch  angle 
displayed  by  the  submarine  models  used  in  this  thesis 
requires  further  investigation.  In  particular,  performance 
and  transient  response  for  models  linearized  about  a 
straight  and  level  trajectory  should  be  compared  to  the 
simulations  presented  herein.  Such  a  comparison  should 
allow  a  determination  to  be  made  as  to  whether  or  not  gain 
scheduling  needs  to  performed  on  the  basis  of  roll  angle  as 
well  as  forward  velocity. 

The  gain  scheduling  algorithm  described  in  the  previous 
chapter  is  an  idealization  in  that  the  compensator  matrices 
were  updated  on  each  iteration  of  the  integration.  An 
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actual  implementation  o-f  gain  scheduling  might  require  that 
an  overlapping  step  type  o-f  approach  be  used  to  decrease 
both  the  computational  burden  and  the  possibility  o-f 
introducing  instabilities  into  the  controller. 

In  so  far  as  the  purpose  of  this  thesis  was  to  present  an 
LQG/LTR  design  example  and  demonstrate  the  technique  of  gain 
scheduling,  the  reference  plane  problem  was  ignored. 
Unfortunately,  controlling  a  submarine  in  an  inertial 
reference  frame  utilizing  a  body  coordinate  system  somewhat 
abstracts  the  state  space  description  of  the  submarine 
model.  To  make  the  conversion  externally,  however,  presents 
the  control  system  designer  with  a  time  varying  C  matrix. 
Replacement  of  the  state  variables  w  and  r  with  the 
derivatives  of  z  and  y  would  provide  a  more  useful  set  of 
state  variables  for  the  purposes  of  controller  design. 

Although  the  submarine  has  six  degrees  of  freedom  in  its 
environment,  the  three  control  surfaces  permit  the  control 
of  only  three  output  variables.  Of  course  the  constant  rpm 
constraint  placed  on  the  model  in  this  thesis  is  artificial, 
and  was  intended  only  to  reflect  current  operating 
procedures.  The  addition  of  propulsion  control  and 
differential  action  for  the  control  surfaces  (rudders  and 
stern  planes)  would  provide  a  total  of  6  controls,  yielding 
a  much  more  flexible  system. 
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AppandiM  A 


Stata  Spaca  Matricaa  for  tha  Linaarizad  Modal a 


Tha  al affiants  of  the  A  and  B  matrices  are  presented  in  the 
standard  row  and  column  -format.  In  the  case  o-f  the  A 
matrices,  the  10  elements  of  each  row  are  displayed  as  two 
rows,  containing  the  first  five  elements  in  one  row  and  the 
second  five  elements  in  the  next. 


i 

■  ■  ■  '  ■ 

1 

Model  S5R5 

' 

* 

1 

A  Matrix 

-.8532E-02 

1166E-01 

1594E-03 

1001E-01 

.  2036E-»-00 

. 1590E+01 

•  0000E*^00 

. 2954E-03 

.  00008*^00 

.  0000E'*'00 

1  ••  .  1532E-02 

'.4036E-01 

. 1187E-02 

-.3551E+00 

. 1268E^00 

- - - 

» 

-.2569E+0i 

. lSiaE+00 

-.2805E-04 

. 0000E+00 

. 0000£*00 

-.2690E-03 

. 6475E-03 

-.22&6E-01 

••.8010E-I-00 

.2183E-*-01 

1840E-01 

.  0000E-^00 

.7616E-02 

.  0000E-^00 

.  0000E'*-00 

I  -.3420E-04 

-.2184E-02 

-.7419E-03 

~.8579E-01 

1323E-^00 

1 

1544E-01 

1621E-I-00 

.3450E-04 

.  0000E-*>00 

.  0000E4-00 

-.77S9E-05 

.624SE-05 

. 2208E-03 

~.&028E-02 

-.8562E~01 

-.5396E-03 

.  0000E-^00 

-.2512E-02 

.  0000E-^00 

.  0000E-t-00 

1  -.2941E-04 

-.2764E-03 

7509E-05 

1346E-02 

-.7110E-04 

«  , 

-.8534E-01 

.2618E-03 

“.5572E-07 

.  0000E-<-00 

.  0000E-I-00 

.0000E-i‘00 

. 0000E*00 

.  0000E-^00 

.  1000E-I-01 

.2128E~03 

-.2027E-01 

.5899E-12 

-.&549E-02 

.  0000E'«'00 

.  00B0E‘V00 

1  . 0000E*00 

.0000E*00 

.  0000E'^00 

.  0000E’*'00 

. 9999E+00 

. 1050E-01 

.6547E-02 

.0000E-^00 

.  00008-^00 

.  0000E'«-00 

.  000OE'^00 

.  O000E'^00 

.  0000E-»'00 

.  0000E-^00 

1050E~01 

.  1000E-*>01 

-.2911E-10 

. i327E-03 

.  0000E-i'00 

.  8B00E'^00 

1  . 2027E~01 

1050E-01 

. 9997E+00 

.  0000E-*-00 

. 0000E+00 

1 

.  0000E*^00 

. 7882E+0O 

-.9643E+01 

.  0000E1-00 

m  00008*^00 

B  Matrix 

1 

1122E-02 

-.2826E-02 

1137E-01 

. 0O00E>00 

. B000E+00 

. 8949E-01 

-.7633E-01 

-.S624E-01 

-.2885E-0& 

.  0O00E-^0O 

.  0000E-I-00 

. 1661E-02 

1845E-02 

.5402E-03 

.9514E-07 

.00O0E-»-00 

.  0000E'i-00 

-.2266E-02 

r- 

.0000E*^00 

.  0000E-i'00 

. 0000E>00 

■ 

.  0OO0E-H9O 

.  B000E-»'00 

.  0000E<^00 

L 

.000OE-I-00 

.  0000Ei'00 

.  0000E-«>00 

1 

.  0000E-»-00 

.  0000E'i'00 

. 0000E>00 

1 
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'1 

1 

Model  S1BR5 


1491E-01 

.2832E-^01 

.2771E-02 

4S62E+01 

-.4935E-03 

1274E-01 

-.A136E-04 

-.2096E-01 

14A7E-04 

-.1162E-02 

-.5373E-04 

ISlSE-t-BB 

. 00a0£*00 

7024E-01 

. 0000E+00 
.3312E-01 

. 0000E+00 
. 1002E+01 

.7011E-01 
.  0000E'^00 


A  Matrix 


.2067E-01 
.  0000E-t'00 

.7168E-01 
.  1314E-*'00 

. 1470E-02 
. 0000E+00 

-.3913E-02 

1616E-i'00 

.AA35E-05 
.  0000E-t-00 

-.4895E-03 

.2&11E-03 

.  0000E+00. 
.9818E-10 

.  0000E-^00 
. 1162E-01 

.  0000E-*-00 
1400E-08 

-.3304E-01 
. 1398E+01 


-.3512E-02 
. 0000E+00 
-.2467E+00 
.  0000E-^00 
5992E-02 
.  0e00E-^00 
.  0000E-^00 
. 0000E>00 
. 0000E>00 
.  0000E-^00 


-.7935E-03 
. 2948E-03 

. 11S2E-02 
-.3061E~03 

-.4014E-01 
. 7599E-02 

1330E-B2 
. 3765E-03 

.3919E-03 

-.2506E-02 

-.7697E-0S 

&081E-06 

•  00B0E'*'00 
1168E-01 

.  0000E'*’00 
.  BBBBE-t-BB 

.  0000E-^00 
.8189E-03 

. 9970E^00 
1709E+02 

B  Matrix 

-.8903E-02 
. 0000E*00 
1772E+00 
.  BBBBE-f-BB 
.  1702E-02 
.  0000E-»-00 
.  0000E-«-00 
.  0000E-»-00 
.  0000E-^00 
.  0B00E-^00 


1777E-01 
.  0000E'^00 

5860E-»-00 
•  0000E'^00 

1427E+01 
. 0000E+00 

1522E-I-B0 
.  0000E'^00 

1069E-01 
• 0000E^B0 

-.2670E-02 
m  0000E-*‘00 

.  1000E-^01 
.  0000E-<>00 

.  0000E'^00 
. 0000E*00 

. 0000E*00 
.  0000E-^00 

.  00008*^00 
.  0000E<»-00 


-.3S82E-01 
.29108-^00 
90878-06 
.51918-02 
. 29978-06 
-.74048-02 
.  00008-^00 
.  0000E-I-00 
.  0000E'»-00 
.  0000E4-00 


.  2705E-<-0B 
.  0000E'*'00 

.  2069E-»-0B 
.  00008 -*-00 

.38718+01 
. 00008+00 

-.23748+00 
. 00008+00 

15198+00 
. 00008+00 

.83188-03 
. 00008+00 

. 23288-02 
. 00008+00 

. 99958+00 
. 00008+00 

-.33208-01 
. 00008+00 

. 00008+00 
. 00008+00 
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A  Matrix 


-.2889E-01 

.5643E-f81 

-.4046E-01 
. BBBBE+BB 

-.6327E-02 
. 2754E-03 

-.3487E-B1 
.  BBBBE-t-BB 

-.4169E-i^B 
.  000BE-t-00 

. 5539E-02 
-.9060E+01 

1416E-^00 
. 1216E+00 

-.8891E-02 

-.6676E-02 

-.6934E-t-B0 
•  BBBBE-t-BB 

.  18B3E-I-BB 
.  BBBBE-t-BB 

1206E-02 
. 1720E+00 

. 7565E-02 
.  0000E-»-00 

-.SS81E-01 
. 7099E~02 

-.2851E-I-01 
.  BBBBE-t-BB 

.7576E-t-01 
.  BBBBE-t-BB 

-.6092E-04 

.2341E-01 

-.8099E-02 
— . 1496E+00 

-.2414E-02 

.8211E-02 

-.3005E-I-B0 
■  BBBBE-t-BB 

~.4355E-t-BB 
.  00B0E-t-0B 

3405E-04 

-.5757E-02 

3369E-04 
.  BBOBE-i-BB 

. 7281E-03 
-.2342E-02 

-.2B96E-B1 
.  BBBBE-t-BB 

-.2998E-t-BB 
.  BBBBE-t-BB 

1078E-03 

-.2994E+00 

-.9620E-03 

.2417E-03 

. 4209E-04 
1326E-04 

-.792SE-02 
.  BBBBE-t-BB 

. 1271E-01 
.  BBBBE-i-BB 

. 0000E>00 
-.3853E+00 

.  BBBBE'+BB 
-.90S9E-09 

.  BBBBE-i-BB 
-.2650E-01 

.  IBBBE-t-Bl 
.  BBBBE-t-BB 

.5434E-B1 
.  BBBBE-i-BB 

. 1397E+00 

.  BBBBE-i-BB 
.2302E-01 

.  B000E-4>00 
•  BBBBE't'BB 

.  BBBBE-t-BB 
.  BBBBE-t-BB 

.  99B2E-t-00 
.  BBBBE-t-BB 

.  0000E-^00 
. 1063E+01 

.  B000E-I-00 
. 2498E-08 

.  B000E-4-00 
. 9609E-02 

.  BBBBE-t-BB 
.  0000E-t-00 

1499E-t-00 
.  BBBBE-t-BB 

.  3626E-«>00 
.  0000E-^00 

1302E+00 

.2619E+01 

. 9228E+00 
-.3159E+02 

.  0B00E-t-00 
.  BBBBE-t-BB 

.  BBBBE-t-BB 
.  BBBBE-t-BB 

B  Matrix 

1372E-01 
.  BBBBE-t-BB 
— . 9636E+00 
.  BBBBE-t-BB 
-.2341E-01 
.  00B0E'*'00 
.  BBBBE'^’BB 
.  BBBBE-^BB 
.  BBBBE-^BB 
. 00B0E>B0 

-.3478E-01 
.  BBBBE'i'BB 
-.6921E+00 
.  BB0BE-I-00 
. 6648E-02 
.  BBBBE-t-BB 
.  BBBBE-t-BB 
.  BBBBE-t-BB 
.  BBBBE-t-BB 
.  BBBBE-t-BB 

1399E-t-BB 
.  1 137E-t-01 
-.355BE-05 
.2B28E-01 
. 1171E-B5 
-.2892E-01 
.  BBBBE-t-BB 
.  BBBBE-t-BB 
.  BBBBE-t-BB 
.  BBBBE-t-BB 
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A  Matrix 


.3521E-01 

-.4803E-01 

1255E-01 

-.4146E-01 

.6762E+01 

.  0000E'*‘00 

.  2343E-03 

. 00008+00 

. 69S3E-02 

1718E-«>00 

-.26058-01 

-.31378+00 

.  1124E-<>02 

.  1017E-^00 

-. 1850E-01 

. 00008+00 

. 1901E-02 

. 1686E-01 

-.  1060E-i-00 

-.34278+01 

.4i73E-»-00 

.0000E-*-00 

. 6039E-02 

.00008+00 

.3581E-04 

1038E-01 

-.2127E-02 

-.36798+00 

.  1083E-t-00 

1251E-t-00 

.2275E-01 

.00008+00 

. 4478E-04 

~.93S8E-04 

.87138-03 

-.24918-01 

. 132SE-01 

.0000E-^00 

-. 1992E-02 

.00008+00 

. 1331E-03 

1197E->02 

.112SE-03 

-. 12428-01 

.  36S2E-^00 

. 2020E~03 

-.3676E-04 

m  WWC^W 

.  0000E-i-00 

.  0000E4-00 

.a00OE4>eO 

• 

. 10008+01 

.7482E-^00 

% 

2a64E-08 

-.4430E-ai 

a  WVnPB.^W 

,  0000E4-00 

.  aaBBE-t-aa 

.0000E-»^Be 

a  IPWWIRp.^  W 

.  2303E-I-00 

.2784E-ai 

.00eoE-*-00 

.00008+00 

. 0000E+00 

.  0000E4>00 

.0000E4-0e 

.00008+00 

.  1227E-I-01 

. 4699E-08 

.27008-01 

.00008+00 

.  6095E-i-00 

182SE-«^ 

.7715E+00 

.00008+00 

.0000E-*-00 

.2750E-I-01 

-.32858+02 

.00008+00 

B  Matrix 

-.2061E>01 

-.52218-01 

-.21018+00 

.0000£-*-00 

.00008+00 

. 27038+01 

1444E-I-01 

-. 10398+01 

-.53298-05 

.0000E-^00 

.00008+00 

. 30468-01 

3508E~01 

.99818-02 

. 17588-05 

.  0000E'^00 

.00008+00 

-.43338-01 

.00a0E-»-00 

.00008+00 

.00008+00 

.  0000E-^00 

. 00008+00 

.  0000E-^00 

. 00008+00 

. 00008+00 

.  0000E+'00 

. 00008+00 

. 00008+00 

>.  1606E*(B1 
m  00OOE'^00 

>.  1038E-I-00 
.  0000E-»-00 

.9191E+01 
.  0000E-^00 

~.3943E+00 

.0000E-i>00 

-.36BlE-i‘00 
.  0000E4-00 

.298SE-'01 

.0000E*«>00 

.  1770E-*>00 
.  0000E-t>00 

.973lE-*«0 

.0000E-HB0 

-.290SE+00 

.e0BQEi-00 

.0000E-^00 

.0000E'i-00 
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AppandiM  B 


nodal  Analysis  Products 


All  matrices  are  presented  in  the  standard  row  and  column 
format.  Additionally,  the  data  in  appendices  B2  through  B& 
nr9  complex  numbers.  These  numbers  are  always  displayed 
with  the  imaginary  part  directly  below  the  real  part.  For 
example,  each  row  of  a  matrix  with  complex  entries  would  be 
displayed  as  two  rows,  the  real  parts  in  one  row  and  the 
corresponding  imaginary  parts  in  the  second  row.  The 
eigenvectors  are  presented  as  (complex)  column  vectors. 
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Apptndix  Bi 


Hatricps  Used  to  Perfori  Unit  Transtoreations 

1.  Matrix  used  to  preeultiply  both  the  A  and  6  aatrices: 


l.NNE+N  I.NME+N  I.NNE^  I.NNE^U 
I.MNE^  1. ••••£*••  I.MNEtW 
I.NNE^N  a.MNE^U  l.MNE+ll  a.MBK^N 

a.aaaaE^aa  a.aaaaE«aa  a.aaaaE+aa  5.73aaE*ai 
a.aaaaE^aa  a.aaaaE+aa  a.eaaaE^aa  a.aaaaE^aa 
a.aaaaE+ea  a.aaaaE^ea  a.aaaaE^aa  a.naaE^aa 
a.aaaaE^N  a.aaaaE^aa  a.aaaaE^aa  a.aaaaE^ 
a.aaaaE^aa  a.aaaaE^aa  a.aaaaE+aa  a.aaaaE^aa 


a.aaaaE^aa  a.aeaeE^aa  a.aaaaE^ae  a.aaaaE^aa 
a.aaaBE^aa  a.aaaeE+aa  a.aaaaE^aa  a.aaaaE^aa 
a.aaaaE^aa  a.eaaaE+aa  a.aaaaE^aa  a.aaaaE+aa 
a.aaaaE^aa  a.aaaaE^aa  a.aaaaE^aa  a.aaaaE^aa 
s.73aaEfBi  a.umm  a.aaaaE^ae  a.aaaaE^aa 
a.aaaaE^aa  s.73aaE+ai  a.aaaaE+aa  a.waaE^aa 
a.aaaaE+aa  a.aaaaE^aa  s.73aaEtai  a.aaaaE^^aa 
a.aaaa£+aa  a.aaaaE^aa  a.aaaaEtaa  5.73a8E+ai 


2.  Matrix  used  to  postaultiply  the  A  eatrix  only: 


i.aaaaE^aa  a.aaaaE^aa  a.NaaE+aa  a.aaaaE^ai 
a.aaaaEtaa  i.aaaaE^aa  a.aaaaE+aa  a.aaaaE^aa 
a.aNaE>aa  a.aanE^aa  i.aaaaE^aa  a.aaaaE^n 
a.aaaaEiaa  a.aaaaE*N  a.aaaaE^  i.7452E-a2 
9.uuE*M  a.aaaaE^aa  a.aaaaE^N 

a.NaaEtaa  a.aaaaE^aa  a.aaaaE«aa  a.aaaaE^N 
a.aaaaE+aa  a.aaaaE^  a.aaaaE^aa  a.aaaaEtai 
t.iUK+u  B.aaaaE^H  a.aaaaE>aa  a.aaaaE^aa 


a.aaaaE^aa  a.aaaaE+aa  a.aaaaEfaa  a.uaaE+aa 
a.aBB8Etaa  a.aaaaEiaa  a.aaaaE^aa  a.aeaaEtea 
a.aaaaE^aa  a.aaaaE^aa  a.aaaaE^aa  a.aaaaEtaa 
a.eaaaE^aa  a.aaaaE^aa  a.NaaE^aa  e.aaaaE^^aa 
i.7452E-a2  a.eaaaE+aa  a.aaaaE+aa  a.aaaaE^aa 
a.aaaaE^aa  i.7452E-a2  a.naaE^aa  a.aauE^aa 
a.aaaaE+ea  a.aaaaE^ee  i.7452E-a2  a.aaaaE^n 
a.aaaaEfaa  a.aaaas^aa  a.eaaaE^aa  i.74S2E-a2 


3.  Matrix  used  to  postaultiply  the  B  eatrix: 

5.73aaE«ai  a.aaaaE+aa  a.aaaaE+aa 
a.aaNE^aa  5.73nEiai  a.aeaaE^aa 
a.aaaaE^ea  a.NaiE^N  5.73aeE+ai 
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Appendix  62 


Kadsl  Decoaposition  ^or  Hodel  SSR5 


Eigenvalues 

-1.1277E-82  -2.6789E-a2  -2.7639E-a2  -2.7689E-02  -4.168i£-02  -4.168&E-82  -5.33832-82  -9.82i5E-02 
0.8808E+08  8.8888E+80  i.7643E-82  -1.7643E-82  3.976IE-81  -3.9761E-81  0.08082^88  6.0838E+08 


Eigenvectors 

9.9281E-01  7.4178E-81  8.9904E-02  8.9984E-82  -2.9654E-83  -2.9654E-03  -6.5228E-02  2.4125E-01 

8.888aE+8a  8.80eaE«'08  :.2SS2E-02  -3.25522-02  -3.2693E-83  3.2&93E-83  8.a808Ef08  8.30882^88 

1. 19412-81  6.45082-81  2.97782-02  2.97782-02  -2.28842-01  -2.20842-01  1.61242-02  -9.70072-01 

0.8088E>a8  8.08882^88  -7.35282-03  7.35282-83  -2.75882-81  2.75802-81  8.08002^08  0.00082+00 

-1.89442-03  8.59422-02  7.54592-01  7.54592-01  -5.58242-81  -5.58242-01  -9.43032-01  -8.92532-03 

8.88882+80  8.08082+00  5.94932-81  -5.94932-81  -5.44822-02  5.44022-02  0.00002+00  0.80082+88 

-2.94322-05  2.54112-04  1.73942-03  1.73942-03  -5.15192-02  -5.15192-82  -1.33532-03  -1.87842-83 

0.80002+08  0.00082+08  1.33942-04  -1.33942-04  2.73092-01  -2.73892-01  0.08002+00  0.08002+80 

7.42722-05  -2.46962-04  -6.80742-03  -4.80742-03  -4.84472-03  -4.04472-03  1.39282-02  -2.50312-84 

8.00802+00  0.00002+00  4.81922-83  -4.81922-03  -9.27172-84  9.27172-04  0.08002+00  0.08882+00 

-8.44222-04  -3.54402-03  -3.14912-04  -3.14912-04  -5.99112-04  -5.99112-04  1.15242-04  -2,07012-02 

0.00802+00  0.88002+08  -2.71892-04  2.71892-04  -8.41372-84  8.61372-04  0.00002+08  0.00002+00 

-1.78192-03  -9.04142-03  1.15542-03  1.15542-03  6.92842-01  6.92842-01  -6.95902-03  1.58942-82 

0.88002+00  0.00882+00  -6.81142-03  4.81142-03  5.48782-02  -5.48782-02  0.80082+00  0.08082+80 

-4.94092-03  1.28482-02  2.52882-01  2.52882-01  -1.52382-03  -1.52382-03  -2.60432-01  3.75332-03 

0.00802+80  0.00002+00  -1.12952-02  1.12952-82  -1.00972-03  1.00972-83  0.00082+00  0.00002+00 
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Appendili  B2  (cont'd) 


Hodei  SSR5 


Control  lability  Hatrix 


2.2815E-93  -2.3a25E-01 
-1.2849E'10  1.35fl0E-ll 

-B.5t45E-03  2.8357E-01 
6.1762E-11  -1.3758E-11 

5.7778E-02  -7.9711E-03 
2.7335E-02  5.7777E-03 


3.2358E-03 

1.8821E-10 

8.3133E-03 

♦.5045E-11 

-8.M24E-02 

B.5281E-02 

-8. 49248-02 
-e.S281E-02 

-1.4243E-03 

7.2981E-05 

-1.4243E-03 

-7.2982E-05 

-1.5716E-B1 

-7.2641E-10 

2.S414E-04 

7.S013E-I2 


5.7770E-02 

-2.7335E-02 

1.5582E-04 

4.1261E-85 

1.5582E-84 

-4.126tE-05 

1.14I0E-01 

-6.0431E-I0 

2.5224E-84 

7.6491E-13 


-7.97118-03 

-5.7777E-03 

4.90408-04 

-3.29508-03 

4.90408-04 

3.29508-03 

4. 53518-03 
-1.79138-10 

7.03428-02 

3.61128-13 


Observability  Matrix 


-1.89648-04  8.59628-33  7.54598-02  7.54598-02  -5.58268-02  -5.58268-02  -9.63038-02 

0.00008^00  0.00008+00  5.96938-02  -5.96938-02  -5.44028-03  5.44028-03  0.00008+00 

-8.44228-04  -3.56408-03  -3.14918-04  -3.14918-04  -5.99118-04  -5.99118-04  1.15268-04 

0.00008+00  0.00008+00  -2.71898-06  2.71898-06  -8.61378-04  8.61378-04  0.00008+00 

-4.94098-03  1.28688-02  2.52388-01  2.52888-01  -1.52388-03  -1.52388-03  -2.60438-01 

0.00008+00  0.00008+00  -1.12958-02  1.12958-02  -1.00978-03  1.00978-03  0.00008+00 


-8.92538-04 

0.00008+00 

-2.07018-02 

0.00008+00 

3. 75338-03 
0.00308+00 
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Appendix  B3 


Modal  Decosposition  (or  Model  S10RS 


Eigenvalues 


-1.9948E-02  -2.2087E-02  -2.2087E'02  -4.786IE-02  -7.2735E-02  -7.273SE-02  -1.4962E-0I  -1.752SE-01 
3.0800E408  1.5563E-32  -1.5Sd3E-02  0.3e80E*0B  3.8643E-01  -3.86438-01  0.00008+00  0. 03008+00 


Eigenvectors 


-9.90448-01 

-5.47628-03 

-5.47628-03 

-7.36658-01 

-9.31568-03  -9.31568-03 

6.23798-02 

2.37538-01 

0.00008+08 

4.95648-02 

-4.95648-02 

0.00008+00 

4.84738-03  -4.84738-03 

0.00008+00 

0.00008+00 

-1.23758-01 

2.03878-03 

2.03878-03 

-6.73618-01 

-2.99048-01  -2.99048-01 

-3.50118-02 

-9.70658-01 

8.00008+00 

4.34908-02 

-4.34908-02 

0.00008+00 

2.20708-01  -2.20708-01 

0.00008+00 

0.00008+00 

-5.91468-02 

6.52238-01 

6.52238-01 

-5.68628-02 

-2.06SI8-01  -2.06508-01 

9.77688-01 

4.71488-04 

0.00008+00 

7.26988-01 

-7.26988-01 

0.00008+00 

7.18378-01  -7.18378-01 

0.00008+00 

0.00008+00 

1.43788-04 

1.59768-03 

1.59768-03 

-6.46658-04 

1.82408-01  1.82408-01 

-3.10778-03 

-6.20088-03 

0.00008+08 

-1.86168-03 

1.86168-03 

0.00008+00 

8.53338-02  -8.53338-02 

0.00008+00 

0.00008+00 

-3.59898-04 

5.01268-04 

5.01268-04 

6.43628-05 

-2.61808-03  -2.61808-03 

-2.91578-02 

-1.99738-03 

0.80088+00 

5.65928-03 

-5.65928-03 

0.00008+00 

4.70888-03  -4.70888-03 

0.00008+00 

0.00008+00 

8.71448-04 

-1.09588-04 

-1.09538-04 

3.62718-03 

-1.31688-03  -1.31688-03 

-2.02808-04 

-2.03828-02 

0.80808+00 

-1.68598-04 

1.68598-04 

0.00008+00 

5.27388-04  -5.27308-04 

0.00008+00 

0.00008+00 

4.18968-03 

-7.35948-03 

-7.35948-03 

1.68908-02 

1.27258-01  1.27258-01 

3.61178-02 

2.81278-02 

0.00808+00 

-1.44058-02 

1.44058-02 

0.00008+00 

-4.96258-01  4.96258-01 

0.00008+00 

0.00008+00 

1.41498-02 

1.04438-01 

1.04438-01 

-7.95598-03 

-2.05428-03  -2.05428-03 

1.92008-01 

1.33758-02 

0.08008+00 

-1.74678-01 

1.74678-01 

0.00008+00 

3.44318-03  -3.44318-03 

0.00008+00 

0.00008+00 
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Appendix  S3  (cont'd) 


-5.9146E-I3 

0.9eME*9i 

8.7144E-8* 

a.MNE^ei 

1.4149E-I2 

a.NBflE^ao 


Hcdel  S18RS 


Controllability  Matrix 

2.3370E-«2  2.9a72E-83  7,7715£-81 
•B.5265E-11  1.2147E-18  -1.1231E-10 

-2.6o58£-81  -1.5il5E-82  -2.3874E-02 
6.0766E-02  5.3814E-82  -3.6798E-02 

-2.6658E-81  -1.5615E-82  -2.3874E-82 
-6.376AE-82  -5.3814E-82  3.A798E-82 

-1.531fl£-82  -5.2494E-83  -9.1870E-01 
-1.423iE-10  8.9197E-11  5.8874E-11 

-2.l579E-a3  -4.6727E-84  1.7B65E-82 
-1.1457E-82  1.3861E-03  2.6I27E-83 

-2.1579E-83  -4.i727E-84  1.7865E*B2 
I.14S7E-82  -1.30ilE-83  -2.S127E-03 

1.7643E-81  -7.9939E-02  -1.8083E-B2 
-9.0616E-11  3.3785E-18  -1.B464E-10 

I.2607E-03  I.0258E-03  2.3037E-01 
-9.74e8E-12  i.0880E-ll  1.8121E-13 


Observability  Matrix 

&.5223E-82  6.5223E-02  -5.6862E-03  -2.86SBE-82  -2.0658E-02  9.7768E-82  4.714SE-05 

7.2&93E-82  •7,2i98E-02  8.08B0E+e0  7.1837E-02  -7.1337E-82  B.8e8BE*0e  8.8880E^80 

-l,095SE-04  -1.095SE-04  3.6271E-B3  -1.3168E-83  -1.3168E-03  -2.0288E-04  -2.83B2E-02 

•l.b8S9E-04  1.8359E-a4  8.88e8E>08  5.2738£-e4  -5.2738E-84  8.8ae0Ef0e  0.88808^88 

1.0443E-81  1.0443E-01  -7.9559E-03  -2.0542E-03  -:.0542E-83  1.9200E-01  1.3375E-02 

-1.7467E-81  1.7467E-01  0.8808Et8e  3.4431E-83  -3.4431E-e3  8.8088E*88  0.0e88E>38 


ippendiit  S4 


nodal  Secoiposition  tor  node!  328F3 


Eigenvalues 

-1.5186E-02  -3.9975E-a2  -5.7097E-a2  -l.a887E-ai  -1.3163E-ai  -1.3163E-01  -3.2738E-ai  -3.5236E-01 
a.aaaaEtaa  a.aaaaE+aa  a.aaaaE^aa  a.aeaaE^ee  3.3086£-ai  -3.388&E-ai  a.aaaaE+aa  a.aaaaEtae 


Eigenvectors 

:.75l6£-a2  9.4999E-01  -5.582<.E-ai  -4.9448E-8I  2.3784E-82  2.3784E-02  2.257i£-02  -1.8893E-01 

a.aaaiEt-aa  a.aaaeEtaa  a.aeaaE^aa  a.aaaaE^aa  i.7398E-b2  -i.7398E-82  a.aaaaEtaa  a.eaaaE^aa 

-8.41S5E-82  1.54d7E-01  -2.9B29£-ai  -6.6735E-01  2.3921E-01  2.3921E-01  2.9231E-01  9.e823E-Bl 

a.aaaeE^aa  a.aaaaEtea  a.aaaaE^aa  a.aaaaE^ae  i.39sse-8i  -i.398Se-8i  a.aaeaEtaa  a.aaaaEt-aa 

9.3412E-81  -1.8540E-01  7.7235E-81  -2.444iE*81  8.4294E-fl  8.4294E*01  -9.3751E-01  -1.2439E-01 

a.aeeaE^ea  a.aaaaEtaa  a.aeaaEtaa  a.aaaaEtea  -3.4386E-ai  3.43a&E-ai  a.aaaeEtaa  a.aaaaEtaa 

-8.6414E-a3  4.9214E-a4  -5.2264£-a4  -3.541SE-a3  -1.3906E-a2  -I.8904E-a2  3.7359E-02  3.5I48E-02 

a.aaaaEtaa  a.aaeeEtaa  e.aeaaEtea  a.aaaaEtea  -].ai92E*a!  i.ei92E-0i  a.aaaaEtea  e.aaaeEtaa 

5.8466E-a3  -9.3887E-04  2.9496E-03  -3.:382E-84  5.58a2E-03  5.5a02E-03  4.3789E-02  1.6220E-02 

a.aaaaEtea  a.aeaaEtaa  a.eaaeEtae  a.aaaaEtea  3.73a3E'e4  -3.73a3E-a4  a.aaeeEtaa  a.aaeeEtaa 

9.06BSE-a4  -l.a7I5E-03  1.73SaE-e3  3.7323E-03  I.5456E'03  I.5456E-e3  3.3164E-03  i.9BS3E-02 

B.BflaBEtea  e.aaeeEtaB  a.aaeaEtae  e.aaaeEtaa  2.e937£-03  -i.a937E-a3  a.aaaaEtaB  a.aaaaEtaa 

-2.9824E-02  -2.5B64E-83  -6.4512E-a3  4.6243E-B:  -2.5487E-01  -2.5487E-01  -1.2756E-01  -8.4999E-02 

a.aaaaEtea  a.aaaaEtea  a.aaeeEtaa  a.aaeeEtaa  i.3484E-at  •i.34a4E-ei  a.aeaaEtaa  a.aaaaEtea 

-3.4436E-01  2.3443E-a2  -5.2797E-82  -1.254aE-a2  9.7445E-03  9.7445E-03  -1.2445E-01  -4.7581E-02 

a.aaaaEtea  a.aaeeEtaa  a.aaaaEtea  a.aaaaEtea  -3.26e4E-e3  3.26a4E-e3  a.eaeaEtBa  B.aaeaEtaa 
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Appendiii  E4  (cont'd) 


’.3412E-IJ2 

i.aaetE^M 

9.gi08E-04 

i.maEm 

-3.4436E-01 

0.0e9iEt0a 


Hodel  S2eR5 


Controllability  Hatrix 

4.8721E-81  -4.4081E-03  -1.3048E-02 
1.2372E-09  -5.54i7E-10  -4.4A75E-10 

-9.4816E-01  *2.1125E-01  -3.4381E+09 
-5.3563E-10  5.54I4E-10  -5.04I5E-I0 

-2.747SE+00  -5.9278E-ai  -1.1337E+00 
-B.4954E-10  1.5I49E-09  5.2273E-10 

8.8974E-0I  2.52I2E-il  -3.4319E+00 
-3.48S5E-10  '4.4942E-18  -l.B16eE-09 

1.38aSE-01  i.88SBE-03  -2.7789E-01 

1.2245E-01  -2.6434E-82  l.84b0E-01 

• 

1.3i0SE-01  1.8850E-83  -2.7789E-01 
-1.2245E-01  2.6434E-02  -1.0460E-01 

-4.8970E-01  2.0629E-01  4.02658-01 
-1.1S65E-11  -3.3707E-11  1.2161E-10 

7.6635E-02  -4.6328E-02  -9.4790E-01 
7.11738-10  3.0S13E-12  -4.8438E-18 


Observability  Hatrix 

-1.3548E-02  7.7235E-02  -2.6461E-02  B.4294E-02  B.4294E-02  -9.3751E-02 

0.0008E^0B  0.0000E>00  0.00008*00  -3.4306E-02  3.4306E-02  0.00008*00 

-1.07158-03  1.73508-03  3.73238-03  1.54568-03  1.54568-03  3.31648-03 

0.00008*00  0.00008*00  0.00008*00  1.09378-03  -1.09378-03  0.00008*00 

2.B443E-02  -5.27978-02  -1.25408-02  9.74458-03  9.74458-03  -1.24658-01 

0.00008*00  0.00008*00  0.00008*00  -3.26068-03  3.26068-03  0.00008*00 


-1.24398-02 

0.08908*09 

1.90538-02 

0.00008*00 

-4.75818-02 

0.00008*00 
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ifppendix  S5 


Hodal  Deccaposition  for  Hodel  32SR5 


Eigenvalues 

-1.37g«E-82  -S,2ei4E-02  '4.5531E-82  -1.3479E-il  -1.5137E-il  -1.5137E-I1  -4.22i5E-01  -4.2265E-81 
e.8808E+88  0.e080E>e8  0.0008E*0B  0.008aE>08  2.B421E-01  -2.B421E-01  1.3732E-02  -i.3732E-B2 


Eigenvectors 

2.368SE-B1  -9.&a49E-01  -6.25B6E-01  -6.2a3aE-01  B.S87SE-B3  6.5S7SE-e3  -1.1512E-01  •1.1512E-81 

8.0B8BE>a0  8.aB00E>aa  a.asaaE^aa  a.aaaeE+aa  3.9427E-82  -3.9&27E-B2  2.i>0E2E-a2  •2.&a62E-a2 

-2.2B85E-0I  -2.1244E-81  -3.7I52E-01  -6.BB48E-81  3.1478E-02  3.1A78E-02  6.5027E-01  4.50278-01 

8.B0BBE*00  8.00888^08  0.00088^00  0.0000E>00  2.43938-01  -2.43938-01  5.59888-01  -5.59808-01 

8.91898-01  1.77338-01  4.21928-01  -4.88818-01  9.34408-01  9.34488-01  4.98538-82  4.93538-02 

e.0800E>00  0.80088^00  0.00808^00  0.0000E>0a  -5.04778-02  5.04778-02  -4.4114E-01  4.61148-01 

-1.27348-02  -8.44788-04  -1.44918-03  -8. 1045E-83  1.982H-82  1.98228-02  3.2410E-02  3.24108-02 

0.8Ba0E>08  0.8808E>00  0.00808*00  0.00008*80  -7.89708-02  7.09708-82  5.32918-02  -5.3291E-02 

4.78578-03  8.7878E-84  1. 74 15E-83  -6.59898-04  4.20948-03  4.2694E-03  8.551BE-03  8.5510E-03 

0.00088*00  0.08088*08  0.08008*00  0.08808*08  2.24348-83  -2.24368-03  3.44448-02  -3.44448-02 

1.84728-83  1.48988-03  2.25948-03  3.70028-03  1.30498-03  1.30498-03  1.35208-02  1.35208-02 

8.80808*08  8.88008*00  0.80008*80  0.08808*00  1.33228-03  -i.3322£-03  9.90048-03  -9.9084E-83 

-2.97148-02  9.89258-03  1.68558-02  7.58858-02  -2.23818-81  -2.23318-01  -5.42178-02  -5.42178-02 

0.08808*08  0.00088*00  8.00008*08  0.00888*00  5.23748-02  -5.23748-02  -1.32738-01  1.32788-01 

-3.38798-01  -2.78248-02  -4.05918-82  -1.72348-02  I. 35828-02  1.35028-82  -2.0993E-02  -2.09938-02 

0.00088*00  0.00808*00  0.08008*08  0.00888*00  -7.33808-04  7.33808-04  -7.66338-02  7.64338-02 
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Appendix  BS  (cont'd) 


Nodel  S2SRS 


Controllability  Matrix 


b.27&lE-ai 

-4.7501E-B9 

4.7783E+ei 

-1.B903E-09 

-7.1170E+00 

1.5541E-09 

2.1303E+00 

-1.8864E-09 

3.2985E-01 

2.6104E-01 

3.298SE-01 

•2.bl84E-01 

3.96S3E-01 

5.3461E-01 

3.9653E-01 

-5.3461E-01 


-A.423iE-03 

•3.04A9E-10 

1.845AE*80 

-3.9480E-09 

•l.S909E^08 

S.154&E-09 

6.7327E-01 

-4.6093E-10 

7.A203E-B3 

•S.AAA0E-B2 

7.6203E-03 

5.6A68E-02 

-1.7981E-B1 

•2.188BE-iI 

-1.7981E-I1 

2.188BE-81 


4.8S2iE-02 

-B.7A41E-09 

7.8S08E+00 

-2.8A45E-0B 

-3.8872E+0a 

3.A818E-08 

-5. 01418^00 
-5.5881E-09 

-8. 32758-01 
4.i02AE-Bl 

-8.8275E-01 

-4.1I2&E-01 

-1.10S1E^08 

-3.4475E-01 

-1.10518^00 

3.4475E-01 


Observability  Matrix 

-4,88818-02  9.34408-02 
0.00008*00  -5.04778-03 


8.91898-02 

0.00008*00 

1.84728-03 

0.01008*00 


1.77338-02 

0.00108*00 

1.40988-03 

0.00008*00 


4.21928-02 

0.00008*00 

2.25948-03 

0.00008*00 

-4.05918-02 

0.00008*00 


3.70028-03 

0.00008*00 

-1.72348-02 

0.00008*00 


1.30498-03 

1.33228-03 

1.35028-02 

-7.33808-04 


9.34408-02 

5.04778-03 

1.30498-03 

-1.33228-03 

1.35028-02 

7.33808-04 


4.98538-03 

-4.41148-02 

1.35208-02 
9. 90048-03 

-2.09938-02 

-7.44338-02 


■3.08798-01  -2.78248-02 
0.00008*00  0.00008*00 


4.98538-03 

4.41148-02 

1.35208-02 

-9.90048-03 

-2.39938-02 

7.44338-02 


Appentfii  3& 


1.SI3IE*I7 

I.NNE^N 


9.NI4EMI 

l.aNKtH 


5.i882EtM 

I.I8I8E«88 


4.12S7Etl2 

-1.28I6E*I3 


Nulti variable  Zeroi  for  all  Hodtls 


Model  SSftS 

1.88S4E>I7  l.S42SE>a3  -8.4S43E-I3  -4.2i6SE-82  -4.214SE-a2  -S.36S4E-82  -l.S421E*03 
8.BINEtM  I.II08E^II  B.MIIE^N  3.9774E-I1  -3.9774E-I1  I.B8I8E^B8  l.8888Et0B 


Model  S1885 

7.8271E+I4  -1.4778E-02  -7.42e4E-l2  -7.4284E-I2  -9.4508E-82  -3.4771E+04  -3.477I£*04 
0.8080E^0  0.B080E^  3.8722E-01  •3.87228-01  0.00008^  6.07158*04  -6.07158*04 


Model  52085 

2.51418*04  -2.86528-02  -1.41888-81  -1.41888-01  -2.02748-01  -2.50378*04  -2.02968*09 
0.00008*08  0.00008*00  3.29428-01  -3.29428-11  0.00008*00  0.08008*00  0.00808*80 


Model  S2SR5 

-3.58828-82  -1.72048-01  -1.72048-01  -2.55998-01  -1.09048*03  -1.09048*03  -1.28968*04 
0.00008*00  2.69898-01  -2.69898-01  8.00008*00  7.99318*02  -7.99318*02  0.80008*00 
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AppandiM  C 


8«ln  MatricM  and  Propartiaa  of  tho  Cloaod  Loop 

Plant 
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Appendix  Cl 


5.0993E-01 

S.6308E'01 

1.1576E-02 

5.6803E<01 

4.1466E-03 

5.3033E-02 


8. 1776E-01 
1.3793E+00 

8.S743E>02 

1.6640E+00 

1.8005E-02 

1.304SE-01 


1.4466E')-00 

1.7005E-^00 

3.0242E-01 

2.38S1E>00 

7.0806E-82 

5.20OIE-02 


i.7i70E4-00 

1.71S5E4-00 

4. 1451E-01 
2.3852E>00 

1.0841E-01 

5.4931E-03 


Kalnan  Filter  Gain  Matrices 


Model  SS85 


1.1576E-02  4.1466E-03  1.92&3E-03  -6.8896E-03  -5.6557E-01 
4.7I20E+01  -2.3271E-01  -7.6189E-01  -7.7504E+00 


3.2717E-01  -1.5101E-03  -4.5847E-04  -1.0951E-82  -6.9427E-01 
2.6916E-^01  4,2244E-01  -4.44S0E-01  5.2359E-t-00 


1.5101E-03  1.5507E-01  1.9535E-03  1.3183E-02  -l.n24E-02 
-5.ai94E-01  -4.7611E+00  -2.9808E-02  -8.5289E-02 


Model  S10RS 

8.5743E-02  1.8005E-02  1.7876E-03  -8.3415E-03  -6.2216E-01 

•3.0833E+01  -5.9833E-01  -7.1770E-01  -7.4749E+00 

5.3248E-01  -5.285SE-03  -5.8788E-04  -2.1142E-02  -6.5491E-01 
1.7290E+01  8.3463E-01  -3.7143E-01  6.1774E+00 

-5.2855E-03  2.8319E-01  2.0265E-03  1.3008E-02  -1.5523E-02 

•1.0776E+00  -4.8471E+00  -2.8398E-02  -2.5462E-01 


Model  S20RS 

3.0242E-01  7.0806E-02  2.0844E-03  >9.0445E-03  -6.6S04E-01 

-1.9263E+01  -1.3559E+00  -6.3832E-01  -6.9217E+00 

9.2461E-01  -4.6849E-02  -3.7150E-04  -3.20318-02  -6.0270E-01 

8.5952E't-00  1.6947E«-00  1.7106E-01  6.9342E'*-00 


-4.6849E-02  S.676&E-01  2.1810E-03  1.4902E-02  -7.3951E-03 

-2. 48848^00  -S.0834E>00  -&.&319E-02  -1.23868^00 


4. 14S1E-01 
-1.67148+01 

1.08448+00 

6.72428+00 

-9. 16688-02 
-3.37268+00 


Model 

1.08418-01 

-1.71028+00 

-9. 16688-02 
2. 13718+00 

7.07998-01 

-5.37728+00 


S25R5 

2.48348-03 

-6.21428-01 

1.11448-04 

3.65778-01 

2.25738-03 

-1.31678-01 


-1.22268-02 

-6.68878+00 

-3.92468-02 

7.01798+00 

1.64668-02 

-2.03808+00 


-6.78288-01 

-5.38048-01 

-1.15368-03 
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Appendix  C2 


Control  Sain  Matrices 


-1.0018E-02 
-1.4786E-01 
-1.3888E-01 
-2.0376E-02 
-2.5016E-01 
3.6744E-01 
2.0608E-04 
1. 1480E-04 
4.31S8E-03 
-4.i205E-04 
2.3112E-03 


Model  SSRS 

-5.9555E-02 

-4.9755E-02 

-9.8459E-01 

2.1793E+00 

-2.2573E+00 

4.3158E-02 

1.2104E-03 

1.2587E-04 

3.3125E-02 

1.5528E-02 

8.1370E-03 


-5.0536E-02 
4.0136E-02 
-2.44A2E-01 
3.70UE-O2 
-&.4614E-01 
2.3112E-02 
&.4495E-04 
1.2895E-04 
8. 1370E-03 
4.8S22E-83 
4.087SE-02 


-6.3100E-03 
-1.1706E-01 
-1. 1104E-0i 
-4.2047E-02 
-4.0679E-01 
4.7272E-01 
9.9092E-04 
3.8495E-05 
6.S458E-03 
-3.2026E-04 
2. 1223E-03 


Model  SIORS 

-2.9297E-02 
-1.0929E-0I 
-6.8330E-01 
3. 67088+00 
-3.2997E+00 
6.5458E-02 
5.0252E-03 
-9.81BIE-04 
4.2779E-02 
4.5913E-02 
1.0618E-02 


-2. 1827E-02 
-2.3457E-03 
-1.6012E-01 
4. 1904E-B1 
-9.9766E-01 
2. 1223E-02 
1.8244E-03 
-1.6970E-04 
1.B618E-02 
1.5766E-02 
5. 1121E-02 
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Appendix  C2  (cont'd) 


Control  Gain  llatrices 


-3.0768E-04 

-9.9578E-02 

-5.2549E-02 

-4.0965E-01 

-4.7391E-02 

6.1100E-01 

3.8992E-03 

-5.6741E-05 

5.4639E-03 

-3.9308E-02 

8.5048E'04 


Model  S20RS 

1.8691E-02 
-3.1810E-01 
-4.06aiE-01 
6.7S46£^00 
-4.6661E-i-00 
5.4639E-02 
2.8093E-02 
-1.0044E-02 
5.0574E-02 
1.6695E-01 
8. 1331E-03 


-2.6678E-03 
-4.3207E-02 
-5.9456E-02 
1.5694E+00 
-8.8528E-01 
8.5040E-03 
3.5058E-03 
-1.5228E-03 
8. 1331E-03 
3.6961E-02 
5.8230E-02 


2.3797E-03 
-9.5498E-02 
-3.4741E-02 
-1. 1024E^00 
3.4893E-01 
7.7970E-01 
3.2007E-03 
9.A791E-04 
3.5&28E-03 
-1. 1216E-01 
4.7694E-03 


Model  S25R5 

3.3659E-02 

-4.4344E-01 

-3.1467E-01 

8.030&E>00 

-4.6157E+00 

3.5628E-02 

4.8469E-02 

-1.7839E-02 

4.6331E-02 

2.4663E-0i 

2.2212E-04 


-3.7276E-03 

-5.8065E-03 

-5.7352E-04 

1.5822E^00 

-4.8207E-02 

4.7694E-02 

-4.5751E-03 

1.5633E-04 

2.2212E-04 

1.7557E-02 

5.7978E-02 
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Aooendix  C3 


-7.A489E-01  - 
-3.9ai4E-ai  - 
-3.53l8E-ai  - 


7.7A16E-01  - 
-3.4961E-ai 

0.aa00E>aa 


3.3022E^02 
-2.8652E-a2  - 
-1.4188E-01  - 


6.5409E+a2  - 
B.aaaaE^aa 
-3.2942E-ai 


Poles  of  the  Closed  Loop  Model 


Real  Part 


7.6489E-ai 

1.3606E-ai 

2.a624E-ai 

2.8649E-02 


-6.2486E-ai 

-i.3606E-0i 

-1.2874E-01 

-1.3031E-02 


-3. ia63E-ai 
-1.5198E-01 
“5.7aa9E-02 
-1.3031E-02 


-3.1063E-01  - 
-1.5198E-ai  - 
-5.7a09E-02  - 
-4.6457E-02 


Inaginary  Part 


7.761AE-ai 

3.3397E-01 

a.aaaaE^aa 

a.aaaaE^aa 


a.aaaaE^ea 

-3.3397E-01 

a. aaaaE^aa 

b.  1984E-83 


4.5795E-01 
3.2898E-01 
5.1976E-02 
-b. 1984E-03 


-4.5795E-01 
-3.2898E-01 
-5. 1976E-02 
a.aaaaE^ea 


Zeros  of  the  Closed  Loop  Model 
Real  Part 


3.3022E>02 

9.09UE-02 

2.0274E-01 

S.30SSE>01 


1.758aE*e2 

-9.091IE-02 

-3.2524E-01 

-8.8860E^01 


5.2209E+01 

-1.3101E-01 

-3.4898E-01 

'8.8860E^01 


-1.7678E-a2  - 
-1.3101E-01- 
-4.2233E-01  - 
-8. 1268E+02 


leaginary  Part 


6.5409E+02 

2.2508E-02 

0.0000E+00 

a.0000E->-00 


0.000084-00 

-2.2508E-02 

0.0000E-408 

1.S280E+02 


0.0000E4-00 

3.073&E-01 

0.0000E400 

~1.S280E402 


3.0012E-03 

-3.0736E-01 

5.2639E+01 

0.0000E4-00 


3.9014E-81 
3.2827E-01 
5. 7206E-02 


3.4961E-01 

0.00008400 

0.0000E-400 


1.7678E-02 
1. 41888-01 
4.22348-01 


3.00128-03 

3.29428-01 

5.26398+01 
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Appandix  D 

Gain  Scheduling  Algorithm  and  Coa-ff icianta 


Tha  program  in  appendix  D1  is  written  in  Fortran  77  for 
the  Microsoft  compiler.  It  should  run  on  any  computer 


having  a  Fortran  77  compiler  with  modifications  required 
only  for  the  input /output  statements. 


Aopendix  D1 


Fortran  Proqram  to  Produce  the  Sam  Scheduling  Coe-ff iclents 


progran  natlsq 
c 

c  parabolic  least  squares  fit  with  order  of  polvnonial  taken 

c  as  input  fron  the  console  (nax  order  =  3) 

c  adapted  froe  the  Fortran  proqraa  by  Alan  R.  Miller 

c  this  version  handles  natrices  up  to  11  x  11 

c 

integer  eaxr , eaxc , 1 i nes ,nrow,nco} , eatr , eatc , nax si z 
real  x (5) .ynat ( 1 1 , 1 1 ,5) ,y (5) 
real  coef ( 1 1 , 1 1 ,5) ,carrel .c (4) 
character*!  ansMer 

character»15  fnanelS),  dskfile.  profile 
character>60  title 
connon  /sizes/  nroM.ncol .natr ,matc 
connon  /files/  fnane 
data  naxr.naxc.naxsiz/S,  4,  11/ 
c 

Mrite(», ' (A) ')  '  Specify  title  for  this  run:  (60  chars)' 
read(*,l03)  title 

call  input  (x  ,yiiat  ,eaxr  .maxc .naxsiz ) 
c 

c  Noh  do  the  least  squares  fit,  storing  the  ncol  coeff's  for  the 

c  i.j  tern  in  the  natrix  coeff(i,j,k)  for  k^l  to  ncol.  Store  the 

c  correlation  coefficient  in  coef f (i , j ,ncol +1 ) . 
c 

do  20  i-l,natr 
do  20  j  =  l,inatc 
do  10  k^l.nroH 

10  Y<k)  =  ynatli , j,k) 

call  linfit(x,y,c,correl,naxr,naxc) 
do  IS  ksi,ncol 

15  coef (i , j ,k)  »  c(k) 

coef (i , j ,ncol *1 )  »  correl 
20  continue 


Apoendix  Di  (cont'd) 


Fortran  Proqrani  to  Produce  the  Gain  Schedulinq  Coefficients 


c 

c  Detereine  what  type  of  output  is  desired 
c 

wri te (*,  '  (A\ ) ■ )  '  Write  coefficients  to  output  device?  (Y/N) 
read (*, 100) answer 

if(answer  .eq.  v'  .or.  answer  .eq.  'Y'>  then 

write(*, ' (A\) ')  '  Disk  file  for  Draper?  (Y/N)  ' 
read (•, 100) answer 

if(answer  .eq.  'Y'  .or.  answer  .eq.  'v')then 

writet*, ' (A) ')  '  Enter  the  output  filename:  ' 
write(*, ' (A) ' )  ‘  (example:  ' ' b:coef f . dat '  ' )  ' 
readC*.*)  dskfile 

wr i te(*, '  (A) ' )  '  Writing  output  file . ' 

open(7,  FILE  *  dskfile.  STATUS  =  'NEW') 
write(7,104)  title 

write(7, ' (A) ' )  '  (first  coeff  is  the  constant  term)' 
do  30  i-l,matr 

do  30  j-l,matc 

30  write(7,i0S)i , j« (coef (i , j ,k) ,  k=l,  ncol) 

write(*, ' (A) ')  '  ' 
close(7) 
endif 

write(*, ' (A\) ' )  '  Disk  file  for  printing?  (Y/N)  ' 
read(*.100)answer 

if(answer  .eq.  'Y'  .or.  answer  .eq.  'v')then 

write(*, ' (A) ')  '  Enter  the  output  filename:  ' 
write(*, ' (A) ')  '  (example;  ' 'd; coef f , 1 st ' ' )  ' 
read(*,»)  profile 

wr i te (*, '  (A)  ' )  '  Writing  output  file.. . ' 

open(8,  FILE  *  profile,  STATUS  =  NEW') 
write(8,104)  title 
write(8,101) 
do  35  i-l,oatr 

do  35  j^l.matc 

35  write(8,182)  i , j.coef (i . j ,nco] *1 ) , 

1  (coef (i . j . k ) ,ksi ,ncol ) 

close (8) 
endif 
endif 


Appendix  01  (cont'd) 


Fortran  Propram  to  Produce  the  Gain  Scheduling  Coefficients 


100  foreatlal) 

101  foraatl'  eleaent ‘ ,3x , 'correlation ' ,3x , 

1  'coef f icients (loM  order  to  high  order)'/) 

102  foraatl'  ( ' , i2,  ' ,  '  ,i2. ' )  '  .3x ,el0. 4 ,3x ,5 tel0. 4, 2x ) ) 

103  format {a60) 

104  format!'  ',a60) 

105  format (2x,i2,lx,i2,lx,el2.6,2x,el2.6,2x,el2.6,2x,el2.S) 
end 

c 

subroutine  input (x ,ynat ,maxr ,maxc ,maxsi z ) 
integer  nroM,i ,maxr ,aaxc,ncol ,matr ,natc,naxsiz 
real  x (5) ,ymat ( 1 1 , 11 ,5) 
character>lS  fname<S) 
common  /sizes/  nroM.ncol ,matr ^matc 
common  /files/  fname 
c 

5  write!*, ' (A\) ' )  '  Order  of  polynomial  to  use?  ' 

read !*,«)ncol 

if!ncol  .gt.  maxc-Dgoto  5 
if!ncol  .It.  1)  stop 
ncol  *  ncol+1 

10  write!*, ' !A\) ' >  '  Number  of  speeds?  ' 

read!*,*)nrow 

if!nrow  .It.  ncol  .or.  nrow  .gt.  maxr)goto  10 
write!*, ' !A) ' )  '  Enter  the  speeds  and  corresponding  filenames: 
write!*, '  !A) ' )  '  !example:  20.0  ' 'b: abghc. 520 '  ' )  ' 

read!*,*)  !x !i) ,fname!i) ,  i«l,nrow) 

15  write!*, ‘  !A\) ' )  '  Specify  matrix  dimensions:  !row,col)  ' 

read!*,*)  oatr.matc 

if!matr  .gt.  maxsiz  .or.  mate  .gt.  maxsiz)  goto  15 

write!*, '  !A)  ' )  '  Reading  input  matrices . ' 

do  20  i>l,nrow 

open!i.  FILE  •  fname(i)) 

read!i,10B)  ! !  j  ,l(  ,ymat !  j  ,k,i ) ,  msl,matc),  n-l,matr) 
close  !i ) 

20  continue 

write!*, 101) 
return 

100  format !lx.i2,lx,i2,lx,elb.l0.1x,i2,lx,i2,lx,el6.10, 

1  lx ,i2, lx ,i2, lx .el&. 10) 

101  format!'0') 
end 
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Appendix  D1  (cont'd) 


Fortran  Prograe  to  Produce  the  Sain  Scheduling  CoeFFicients 


subroutine  1  inf  it (x ,y ,coeF ,cor ,naxr .naxc ) 
logical  error 

integer  nroN,ncol  ,i ,  j.iiiaxr,aaxc,fliatr,aatc 
integer  index (S,5) ,nvec 
real  x  ( 1 )  ,y  (1 ) ,coeF ( 1 ) 
real  a(S,S) ,x«atr (5,5) 
real  suey,suAy2,xi ,yi ,yc,res,cor ,srs 
coAAon  /sizes/  nrow,ncol ,Aatr ,«atc 
data  nvec/1/ 
c 

do  10  isi.nroM 
xi  3  X  (i ) 
xeatr (i ,1)=1.0 
do  10  j-2,ncol 

x«atr(i,j)s  xeatr (i ,j~l)«xl 
10  continue 

call  square (xeatr , y,a,coeF,eaxr,eaxc) 
call  gauss j (a,coef ,index ,nvec .error ,eaxc) 
suey  -  0.0 
suey2  >0.0 
srs  >  0.0 
do  20  i>l,nroM 
yi  »  y (i ) 
yc  *  0.0 

do  15  j  >  1,  ncol 

15  yc  »  yc  +  coef(j)  •  xeatrd.j) 

res  »  yc  -  yi 
srs  =  srs  ♦  ressres 
suey  «  suey  yi 
suey2  *  suev2  vi  ♦  yi 

20  continue 

c  take  care  of  the  case  where  the  y(i>  are  all  zero 
c  this  is  guaranteed  to  produce  zero  coefficients  so  cor  >  1.0 
if(suey  .eq.  0.0)  then 
cor  s  1.0 

else 

cor  •  sqrt ( 1. 0>srs/ (suay2-suay*suey/nrow) ) 
endif 
return 
end 
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Appendix  01  (cont'd) 

Fortran  Propran  to  Produce  the  Gain  Scheduling  CoeFF icients 


subroutine  square (x ,y,a,q.Aaxr,aaxc) 
integer  nrow,ncol«i,ktl ,»atr ,eatc , eaxr , eaxc 
real  x <«axr ,«axc) , v Imaxr ) .aleaxc .naxc) ,g (eaxc) 
coeeon  /sizes/  nro«,ncol ,eatr ,»atc 
c 

do  40  k’>i,ncol 
do  20  1-1, k 
a(k,l )-0.0 
do  10  i=l,nrow 

a(k,n*a(k,l)+x(i,l)*x(i,k) 
if  (k  .ne.  1 )  ad  ,k)  =  a(k,l ) 

10  continue 

20  continue 

g (k)  s  0.0 
do  30  i=l,nroM 

g(k)ag(k)+y(i)*x<i,k) 

30  continue 

40  continue 

return 
end 
c 

subroutine  gaussj<b,w,inde*,nvec,error ,»axcl 
logical  error 

integer  nroM,i , j,k,l ,nvec,«atr,*atc,eaxsiz ,eaxc 
integer  iroN,icol,ll , index (naxc,3) 
real  b(eaxc,l)  ,i*(eaxc,l)  ,big, sue, t, pivot, deter e 
coeeon  /sizes/  nrow.ncol ,*atr ,«atc 
c 

error  *  .false, 
n  »  ncol 
do  10  i«l ,n 
index (i ,3) -0 
10  continue 

detere  «  1.0 
do  90  i>l,n 
big  *  0.0 
do  20  j*l.n 

if  (index  (j, 3)  .eq.  Dgoto  20 
do  15  k*l,n 

i f  (index  (k ,3)  .gt.  Dgoto  199 
if (index<k,3)  .eq.  1)  goto  15 
if  (abs(b(j,k>)  .le.  biglgoto  15 
irow  «  j 
icol  •  k 

big  s  abs (b ( j ,k) ) 

IS  continue 

20  continue 
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Appendix  01  (cont'd) 


Fortran  Prograe  to  Produce  the  Sain  Scheduling  Coe-ff icients 


index  (icol  <3)  -  index  (icol  •3>  1 

index(it2)  »  iron 

index  (i , 1 )  -  icol 

ifdroM  .eg*  icollgoto  40 

detere  =  -deter* 

do  2S  l3i,n 

call  swap (b ( i roM , 1 ) «b (icol • 1 ) ) 
continue 

if(nvec  .eg.  0)goto  40 
do  30  l-l,nvec 

call  swap(w(irow,l) .M(icol.l) ) 
continue 

pivot  *  b (icol ticol ) 
deter*  »  deter«*pivot 
b (icol <icol 1.0 
do  45  1-1, n 

b  (icol , 1 )-b (icol . 1 > /pivot 
continue 

if(nvec  .eg.  0)goto  60 
do  50  l*l,nvec 

w(icol,l)  *  w(icoI ,1 ) /pi vot 
continue 
do  80  ll3i,n 

ifdl  .eg.  icoDgoto  80 
t  »  b(ll,icol) 
b (1 1  .icol )  s  0.0 
do  65  1=1, n 

b(ll,l)  =  b(ll,l)-b(icol ,l)*t 
continue 

if(nvec  .eg.  0)goto  80 
do  70  l=l,nvec 

w(ll,l)  »  w(U,l)-w(icol,l)*t 
continue 
continue 
continue 
do  120  i*l,n 
1  ■  n  -  i  *1 

i f (index (1 , 1 )  .eg.  index (1 ,2) )goto  120 
irow  *  index  (1,1) 
icol  =  index (1,2) 
do  110  k  =  1 ,n 

call  swap (b (k , irow) ,b (k, icol ) ) 

0  continue 

0  continue 


Appendix  Di  <cont'd> 

Fortran  Prop^a*  to  Produce  the  Sain  Schedulinp  Coefficients 


do  130  k-l.n 

if  (index  (k, 3)  .ne.  Dpoto  199 

130  continue 

return 

199  write!*, 999) 

error  =  .true, 
return 

999  foreatC  ERROR  -  eatrix  sinpular') 

end 
c 

subroutine  swap(a,b) 
real  a, b, hold 
hold  -  a 
a  -  b 
b  =  hold 
return 
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Appendix  D2 


A-B6-HC  matrix  coe-f-f icients 


element  correlation 


coe-f-f  icients 

(low  order  to  high  order) 


( 

1,  1) 

. 9999E+00 

1694E+00 

-.6S35E-01 

. 2494E-03 

1,  2) 

. 9996E+00 

. 6212E-01 

1287E-01 

-.2528E-03 

1,  3) 

.  lOOOE-t-Ol 

. 2333E-02 

4777E-03 

1583E-03 

1,  4) 

. 9998E+00 

-.2230E-02 

. 7932E-04 

-.3585E-0S 

i,  S) 

. 9479E+00 

. 7586E-02 

1 184E-03 

. 1153E-04 

1,  6) 

. 9972E+00 

.  5033E-I-0O 

. 1461E-01 

-.3083E-03 

1,  7) 

. 98S0E+00 

.3162E-t-00 

-.2128E-»-0O 

. 5342E-02 

1,  8) 

. 9954E+00 

.  65O8E-«'02 

-.4195E+01 

.9159E-01 

1,  9) 

. 9999E+O0 

-.5577E-01 

.6878E-01 

.2617E-04 

1,10) 

. 9987E+00 

.8225E-t-00 

1267E-01 

. 182OE-03 

1,11) 

. 9999E+O0 

.8144E-«-01 

-.7023E-01 

.4817E-03 

2,  1) 

. 9996E+00 

.6212E-01 

1287E-01 

-.2528E-03 

2,  2) 

. 9999E+00 

9588E-01 

4723E-01 

. 3033E-03 

2,  3) 

. 9995E+00 

. 1423E-01 

-.3771E-02 

. 2736E-03 

2,  4) 

.  9966E-t-O0 

. 70O9E-O4 

. 9534E-04 

-.4082E-05 

2,  5) 

. 9954E+00 

, 2375E-02 

. 1945E-02 

1984E-04 

2,  6) 

. 9999E+00 

. 7592E+00 

1101E-01 

. 1825E-03 

2,  7) 

.  9968E-^00 

. 7432E+00 

-.3063E-«>O0 

. 7306E-02 

2,  8) 

.9985E+00 

-.3801E+02 

.2533E+01 

-.S170E-01 

2,  9) 

.  10O0E•^01 

1555E-01 

7298E-01 

.  2372E-03 

2,10) 

.9921E-f00 

.  5869E4-O0 

1893E-01 

-.8110E-03 

2,11) 

.  9976E-I-00 

-.4239E+01 

-.2394E+00 

.5186E-02 

3,  1) 

. 10OOE+01 

.2333E-02 

-.4777E-03 

1583E-03 

3,  2) 

. 9995E+00 

. 1423E-01 

3771E-02 

. 2736E-03 

3,  3) 

. 9999E+00 

-.2462E-01 

-.2536E-01 

-.8143E-04 

3,  4) 

.  lOOOE-^Ol 

1879E-02 

1460E-04 

-.2144E-07 

3,  S) 

. 9984E+00 

1373E-01 

. 1785E-03 

-.1159E-04 

3,  6) 

.9912E+00 

.2321E-01 

. 8328E-03 

6426E-04 

3,  7) 

.  9227E-^00 

.2195E-01 

-.2131E-01 

.8262E-03 

3,  8) 

.  lOOOE-^Ol 

.  2034E-^00 

.6213E-01 

. 2590E-02 

3,  9) 

. 9992E+00 

.6111E4-01 

8634E-01 

. 2780E-02 

3,10) 

. 9952E>00 

.6388E-01 

-.8520E-O2 

. 4451E-03 

3,11) 

. 9999E+00 

.  4404E-*'00 

“.4S12E-01 

.4371E-02 

4,  1) 

.  9998E-*-00 

. 1433E-03 

-.8452E-04 

2997E-04 

4,  2) 

.  9998E-^O0 

.41O6E-03 

-.2215E-03 

7572E-04 

4,  3) 

.  9998E-*'O0 

. 16S2E-02 

-.8909E-03 

-.3046E-*03 

4,  4) 

.9998E-i^ 

1616E-02 

1360E*02 

.4314E-06 

4,  5) 

.9994E>O0 

-.8778E-03 

-.2140E>02 

. 9642E-05 

4,  6) 

.  99O7E-»^O0 

.3420E-O1 

-.7847E-02 

.41O1E-03 

4,  7) 

.9994E+00 

-.7&85E-03 

1833E-02 

.7781E-05 

4,  8) 

.99S8E4^ 

-.4SS6E-<-00 

.  16S0E-i>00 

-.8371E-02 

4,  9) 

. 9967E+00 

-.3616E-*«0 

-.S120E-O1 

.618SE-03 

4,10) 

.  1OO0E-^01 

.0OO0E-I-O0 

.OOOOE-t-OO 

.OOOOE'i'OO 

4,11) 

.9848E-^0 

.  7786E-«-00 

lS87E-t-O0 

. 2462E-02 
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Appendix  D2  (cont'd) 


A-BS-HC  matrix  coe-f-f icients 


coefficients 

element  correlation  (low  order  to  high  order) 


5,  1) 

.  i000E-»-01 

.  0000E-^00 

.  0000E'*'00 

5,  2) 

.  1000E-»-01 

.  0000E-«-00 

.  0000E-4-00 

.  0000E-»'00 

5,  3) 

.  9998E-t-00 

-.2143E-01 

. 8462E-02 

. 2433E-02 

5,  4) 

.1000E4-01 

. 3066E-03 

.2370E-03 

. 1173E-0S 

5,  5) 

. 9997E+00 

-.5286E-02 

6884E-02 

. 7536E-05 

5,  6) 

.  9998E*i'00 

1 165E~01 

. 1008E-01 

-.4830E-03 

5,  7) 

. 9666E+00 

.  IBlBE-i-BB 

1226E-<-00 

.4071E-02 

S,  B) 

. 9735E^00 

1456E't>00 

.6308E-01 

2428E-02 

5,  9) 

. 1000E>01 

.  l911E-f00 

-.5891E-01 

-.8543E-02 

5,10) 

.  9907E-»-00 

.  i214E-»-08 

.2518E-02 

1306E-03 

5,11) 

.  9870E-t-00 

2S66E-^00 

.2130E-I-00 

-.8000E-02 

6,  1) 

.  9998E*»-00 

. 1688E-0i 

-.6976E-02 

-.2069E-02 

6,  2) 

. 9998E>00 

.8178E-02 

4408E-02 

1507E-02 

6,  3) 

. 9998E+00 

.419^-07 

-.2261E-07 

7728E-08 

6,  4) 

.9987E-^00 

-.2842E~03 

. 1458E-04 

-'.3137E-05 

6,  5) 

.9952E+00 

.  4256E-’02 

-.9237E-03 

.5646E-04 

6,  6) 

.  9998E+00 

-.3663E-01 

4365E-02 

-.6024E-04 

6,  7) 

,  9994E+00 

-.6944E-01 

1435Ei>00 

. 3339E-03 

6,  8) 

. 9997E+00 

.  3099E-«-00 

.3689E+00 

-.4837E-03 

6,  9) 

.  9990E-^00 

.6949E>0i 

-.3453E-01 

. 1872E-02 

6,10) 

,  1000E-*-ei 

.0000E-i-00 

.  0000E'^00 

. 0000E+00 

6,11) 

.8381E-^00 

-.5165E-01 

. 7623E-02 

2808E-03 

7,  1) 

.  IBBBE-i-Bl 

.0000E4>00 

.  0000E-*-00 

.  00B0E-«'00 

7,  2) 

.  1000E-i-01 

.  0000E-I-00 

.  0000E-»-00 

.  0000E-<-00 

7,  3) 

.  9998E-*-00 

-.2036E-03 

.  1237E-03 

.  4434E-04 

7,  4) 

.9613E-^00 

.6191E-04 

-.2197E-04 

. 8259E-06 

7,  5) 

.  1000E-I-01 

-.5701E-03 

-.3009E-03 

-.3688E-05 

7,  6) 

.9782E-I-00 

.6719E-03 

-.2997E-03 

.6828E-05 

7,  7) 

.  9998E-I-00 

1383E-01 

1407E-01 

-.5896E-05 

7,  8) 

.  9847E-^00 

.7534E-01 

-.4371E-01 

. 9755E-03 

7,  9) 

.9872E+00 

.3083E-01 

1128E-01 

.4921E-03 

7,10) 

. 9907E+00 

1493E+00 

3097E-02 

. 1606E-03 

7,11) 

. 9774E+00 

.143BE-01 

-,3452E-02 

. 1564E-03 

8,  1) 

.  9998E-*-00 

. 4363E-03 

1735E-03 

-.5014E-04 

8,  2) 

.  9998E-«-00 

-.7851E-04 

. 4234E-04 

. 1447E-04 

8,  3) 

.  9998E<»«0 

1383E-07 

.7456E-08 

. 2549E-08 

8,  4) 

.9998E>00 

1422E-05 

1 105E-05 

-.2545E-07 

8,  5) 

. 9973E+00 

-.2191E-04 

. 7257E-05 

-.4019E-06 

8,  6) 

.  9964E-*«0 

6585E-04 

.5711E-04 

-.9198E-06 

8,  7) 

. 9994E+00 

--.4591E-03 

1105E-02 

.4811E-05 

8,  8) 

.  9998E-i'00 

1466E-01 

>. 1386E-01 

1341E-04 

8,  9) 

.9712E+00 

2680E-02 

.3356E-03 

1202E-05 

8,10) 

.  1000E-^01 

.0000E-*'00 

.  0000E4>00 

.  0000E-^00 

8,11) 

.8166E4-00 

-.4507E-02 

.3768E-03 

1089E-04 

143 


H 


Appendix  D2  (cont'd) 


I 

A-BG-HC  matrix  coe-f-f icients 


coefficients 

element  correlation  (low  order  to  high  order) 


(  9, 

1) 

.  laaaE-i-ai 

.0000E-i>00 

.  0000E-HB0 

.  0000E-I-00 

<  9, 

2) 

.  1000E-I-01 

.  0000E-i-0B 

.  0000E-KS0 

.  0000E-t-00 

<  9, 

3) 

.  9998E-t-00 

. 5768E-03 

-.2201E-03 

-.6176E-04 

<  9, 

4) 

.9999E+00 

3S8aE-05 

-.5043E-05 

-.6170E-08 

<  9, 

S> 

. 9999E+00 

-.6080E-04 

-.4190E-04 

-.  1457E-06 

<  9. 

6) 

.9919E+00 

1029E-03 

-.8578E-04 

. 3225E-05 

<  9, 

7) 

.  9998E-i‘00 

1297E-02 

.  8453E-04 

-.2108E-04 

<  9, 

8) 

.  9968E't-00 

. 6898E-02 

-.  1812E-02 

.  1082E-03 

(  9, 

9) 

. 9997E+00 

-.3057E-01 

-. 1769E-01 

. 9496E-04 

(  9, 

10) 

.  9907E'^00 

.2412E-03 

. 5003E-05 

-.2594E-06 

(  9, 

11) 

. 9929E+00 

1026E-02 

-.  1709E-02 

.6912E-04 

(la. 

1) 

.  laaaE-t-ai 

.  0000E4-00 

.  0000E-*-00 

.  0000E>^00 

(10, 

2) 

.  1000E-»-01 

.  aaaaE-^aa 

.  0000E-*-00 

.  aaaaE-t-aa 

(10, 

3) 

.  1000E-I*01 

. 0000E+00 

.  0000E-*-00 

.  0000E-^00 

(10, 

4) 

. 1000E>01 

.  0000E-i-00 

. 0000E>00 

. 0000E^00 

(10, 

5) 

.  1000E-I-01 

.  0O00E-^00 

.  0000E-^00 

.  0000E-^00 

(10, 

6) 

.9931E>00 

.3843E-02 

-.9352E-03 

. 4867E-04 

(10, 

7) 

.  1400E'«-52 

.  laaaE-i-ai 

•  0000E‘^00 

.  0fS00E-t-ei0 

(10, 

8) 

.9871E-i‘00 

.6741E-01 

1600E-01 

.  8039E-03 

(10, 

9) 

. 9994E+00 

1109E<i-00 

.2537E-01 

-.2415E-02 

(10, 

10) 

. 993SE>00 

-.11258-08 

.  2765E-09 

-. 1371E-10 

(10, 

11) 

.  9883E-^00 

. 1915E-01 

-.  6268E-02 

.  H76E-03 

(11, 

1) 

.  laaaE-i-ai 

.  aaaaE-i-aa 

.  0B00E-^00 

.  0000E-^00 

(11, 

2) 

.  100OE-^01 

.0000E-I-00 

.  0000E-I-00 

.  0000E-«-00 

<11, 

3) 

.  1000E-^01 

.0000E-I-00 

.  0000E-^00 

.  0000E-I-00 

(11, 

4) 

.  1000E-^01 

.  0000E-»-00 

. 0000E^00 

.  0000E-»-00 

(11, 

5) 

.  1000E-KI1 

.  aaaaE-i-aa 

.  0000E-t>00 

.  0000E-^00 

(11, 

6) 

.  8302E-I-00 

-.5870E-03 

. 7487E-04 

-.  2739E-05 

<11, 

7) 

. 1000E+01 

. 0000E+00 

.0000E-^00 

.  0000E•^00 

<11, 

8) 

.  9926E-I-00 

.9916E-I-00 

.  2O57E-02 

-.  1 105E-03 

<11, 

9) 

. 9999E+00 

. 1218E-01 

-.4383E-02 

.5224E-03 

<11, 

10) 

.9996E-i‘00 

.7924E-03 

.  1129E-02 

-.  1651E-0S 

<11, 

11) 

. 9979E+00 

-.2828E-01 

-.  2926E-02 

. 6999E-04 
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Appendix  02  (cont'd) 

G  matrix  coe-f-f icients 

coe-f-f  icients 


elmmsnt 

correlation 

(low  order  to  high 

order) 

( 

1, 

1) 

. 9999E+00 

.  1694E-^00 

.6835E-01 

-.2494E-03 

( 

1« 

2) 

.  9996E-Ka0 

-.6212E-01 

.  i287E-'01 

. 2528E-03 

( 

1. 

3) 

.  IGOOE-Hai 

-.2333E-02 

.  4777E-03 

. 1583E-03 

( 

1« 

4) 

.  9998E4-O0 

.223OE-02 

7932E-04 

. 3585E-05 

( 

1, 

5) 

.9479E+00 

-.7S86E-02 

.  1184E-03 

-.1153E-04 

( 

1, 

6) 

. 9972E+00 

-.5019E+00 

1469E-01 

.  3090E''03 

( 

1» 

7) 

.  985OE-I-O0 

''.3162E+0O 

.2128E-t-O0 

-.5342E-02 

( 

8) 

.  9954E>0O 

~.6508E-«-02 

.4195E-i-01 

9159E-01 

< 

1, 

9) 

.  9999E-I-00 

.  1518E-t-00 

-.7652E-01 

.  75e0E'-04 

( 

1» 

10) 

.  9987E-»-00 

>.822SE'»-0O 

.  1267E-01 

1820E-03 

( 

1» 

11) 

. 9999E+00 

-.8OS8E-i>01 

.6203E-01 

-.2832E-03 

< 

2, 

1) 

. 9996E>00 

-.6212E-01 

.  1287E-01 

. 2528E-03 

< 

2, 

2) 

. 9999E+00 

.  9588E--01 

.  4723E-01 

-.3033E-03 

( 

2, 

3) 

.  9995E-I-00 

1423E-01 

.3771E-02 

2736E-03 

( 

2, 

4) 

.  9966E-I-O0 

-.7009E-04 

-.9534E-04 

. 4O82E-05 

< 

2, 

5) 

. 9954E+00 

-.237SE-02 

1945E-02 

. 1984E-04 

< 

2, 

6) 

.  10O0E-^01 

-.7411E+00 

. 1023E-01 

1646E-03 

< 

2, 

7) 

.  9968E-^00 

7432E+00 

.  3063E-*-00 

7306E-02 

< 

2, 

8) 

.  9985E-^00 

.3801Et-02 

-.2533E+01 

.5170E-01 

< 

2, 

9) 

.  lOOOE-i-Ol 

. 1813E~01 

.  7974E~01 

.2O15E-03 

( 

2, 

10) 

.9921E+00 

-.5869E-I-0O 

. 1893E-01 

.8110E-03 

( 

2, 

11) 

.9982E^00 

.4il6EMh01 

.  2580E-*«0 

-.5719E-02 

( 

3, 

1) 

.  1000E-*-01 

-.2333E-02 

.  4777E-03 

. 15B3E-03 

< 

3, 

2) 

, 999SE+00 

1423E-01 

.3771E-02 

-.2736E-03 

( 

3, 

3) 

. 9999E+00 

.2462E-01 

.2536E-01 

.8143E>04 

< 

3, 

4) 

.  10OOE-^O1 

. 1879E-02 

.  1460E-O4 

.2144E-07 

( 

3, 

S) 

.  9984E-I-O0 

. 1373E-01 

1785E-03 

.1159E-04 

< 

3, 

6) 

.  9820E-^O0 

-.S&91E-02 

1567E-02 

. 7094E-04 

< 

3, 

7) 

.  9227E-^O0 

-.2195E-01 

.2131E>01 

-,8262E-03 

( 

3, 

8) 

.  1O0OE4-O1 

2034E+00 

-.6213E-01 

-.2590E-02 

( 

3. 

9) 

.9955E+00 

4802E-i'0l 

.  1219E'01 

1385E-02 

< 

3, 

10) 

.9952E+00 

-.6388E-01 

.8520E-O2 

-.4451E-03 

< 

3, 

11) 

.  1O0OE-^O1 

-.1199E+00 

.  2822E->01 

-.42008-02 
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Appendix  D2  (cont'd) 


elem( 

<  1, 
<  1, 
(  1, 
<  2, 
(  2, 
<  2, 

<  3, 

<  3, 

(  3. 

<  4, 

<  4, 

<  4, 

<  5, 

<  5, 

<  S, 

<  A, 

(  6, 

<  A, 

<  7, 

<  7, 

<  7, 
(  8, 

<  a, 

<  8, 
(  9, 
<  9, 
(  9, 
(le, 
(10, 
(10, 
(11, 
(11, 
(11, 


H  matrix  coe'f-f icients 


coe-f  f  icients 


int 

correlation 

(low  order  to  high 

order ) 

1> 

. 9999E+00 

1391E-01 

. 8202E-03 

-.6807E-05 

2) 

. 9999E+00 

-.9601E--01 

. 7746E-02 

1019E-03 

3> 

. 997&E+00 

-.8577E-01 

. 8209E>02 

1985E-03 

1) 

.9911E-t-0O 

1806E-t-0O 

.7790E-02 

1782E-03 

2) 

. 9997E+00 

-.2579E-02 

-.6763E-02 

-.4387E-03 

3) 

.9815E-t-00 

.  1236E-»-O0 

1863E~01 

. 5326E-03 

1) 

.  9988E-<'0O 

-.1752E+00 

. 7341E-02 

6687E-04 

2) 

. 9975E+00 

1309E-*-01 

.7416E-01 

1394E-02 

3) 

.  9974E-I-00 

-.3206E'i-00 

. 169OE-01 

1708E-03 

1) 

.9921E+00 

-.3^ilE+00 

.8359E-01 

4474E-02 

2) 

.  9998E-»-00 

. 4895E+O0 

.  3388Et-0O 

1437E-02 

3) 

.  984eE-«-00 

-.7704E+00 

.  1587E-t-00 

2462E-02 

1) 

.  9978E'*^ 

. 4290E-01 

7944E-01 

.  3(i>86E-02 

2) 

.  9983E4-0O 

-.70a9E-«-00 

-.3402E-i‘00 

. 7286E-02 

3) 

.9870E>00 

.25O8E-^00 

-.211SE'i-O0 

. 7923E-02 

1) 

.  9903E-t-O0 

.3376E-«-00 

.6572E-02 

. 4228E-03 

2) 

. 9804E^00 

. 1273E-01 

. 7745E-02 

-.2754E-03 

3) 

. 8302E*0a 

.5870E-01 

74B7E-02 

.2739E-03 

1) 

.9561E-HaO 

-.2202E-02 

. 4746E-03 

-.9889E-05 

2) 

. 10OOEf01 

.3365E-02 

-.9604E-03 

. 1104E>03 

3) 

.  8933E-I-0O 

-.70S4E-02 

. 1677E-02 

-.6174E-04 

1) 

.  91S3E-»-00 

.9755E-a3 

•. 18e0E-03 

. 7340E-0S 

2) 

.  1000E-*'01 

-.9334E-03 

. 437BE-03 

4459E-04 

3) 

.77aiE-«'O0 

.2180E-02 

-.4215E-03 

. 1319E-04 

1) 

. 9804E>0O 

. 1273E-02 

. 7745E-03 

-.2754E-04 

2) 

.  9983E-i'00 

. 1790E-O1 

. 3460E-02 

-.92SIE-04 

3) 

. 9929E+00 

. 1014E-O2 

. i712E-02 

-.6928E-04 

1) 

. 9931E+00 

-.3843E-01 

. 9352E-02 

4867E-03 

2) 

.9998E-»-00 

-.2817E-02 

. 1807E-02 

.3286E>03 

3) 

.9140E'*’00 

•-.2804E>O1 

. 6996E-02 

-.2021E-03 

1) 

.  8302E-»>00 

.S87OE-02 

7487E-03 

.2739E-04 

2) 

. 9929E+00 

. 1014E-O2 

. 1712E-02 

-.6928E-04 

3) 

. 9979E+00 

. 2828E-01 

. 2926E-02 

6999E-04 
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